diff --git a/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335.generic.config.rotek b/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335.generic.config.rotek
deleted file mode 100644
index a7a5d8ce..00000000
--- a/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335.generic.config.rotek
+++ /dev/null
@@ -1,2576 +0,0 @@
-#
-# Automatically generated file; DO NOT EDIT.
-# Linux/arm 4.9.84 Kernel Configuration
-#
-CONFIG_ARM=y
-CONFIG_ARM_HAS_SG_CHAIN=y
-CONFIG_MIGHT_HAVE_PCI=y
-CONFIG_SYS_SUPPORTS_APM_EMULATION=y
-CONFIG_HAVE_PROC_CPU=y
-CONFIG_STACKTRACE_SUPPORT=y
-CONFIG_LOCKDEP_SUPPORT=y
-CONFIG_TRACE_IRQFLAGS_SUPPORT=y
-CONFIG_RWSEM_XCHGADD_ALGORITHM=y
-CONFIG_FIX_EARLYCON_MEM=y
-CONFIG_GENERIC_HWEIGHT=y
-CONFIG_GENERIC_CALIBRATE_DELAY=y
-CONFIG_NEED_DMA_MAP_STATE=y
-CONFIG_ARCH_SUPPORTS_UPROBES=y
-CONFIG_VECTORS_BASE=0xffff0000
-CONFIG_ARM_PATCH_PHYS_VIRT=y
-CONFIG_GENERIC_BUG=y
-CONFIG_PGTABLE_LEVELS=2
-CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config"
-CONFIG_IRQ_WORK=y
-CONFIG_BUILDTIME_EXTABLE_SORT=y
-
-#
-# General setup
-#
-CONFIG_BROKEN_ON_SMP=y
-CONFIG_INIT_ENV_ARG_LIMIT=32
-CONFIG_CROSS_COMPILE=""
-# CONFIG_COMPILE_TEST is not set
-CONFIG_LOCALVERSION=""
-# CONFIG_LOCALVERSION_AUTO is not set
-CONFIG_HAVE_KERNEL_GZIP=y
-CONFIG_HAVE_KERNEL_LZMA=y
-CONFIG_HAVE_KERNEL_XZ=y
-CONFIG_HAVE_KERNEL_LZO=y
-CONFIG_HAVE_KERNEL_LZ4=y
-# CONFIG_KERNEL_GZIP is not set
-# CONFIG_KERNEL_LZMA is not set
-CONFIG_KERNEL_XZ=y
-# CONFIG_KERNEL_LZO is not set
-# CONFIG_KERNEL_LZ4 is not set
-CONFIG_DEFAULT_HOSTNAME="(none)"
-# CONFIG_SWAP is not set
-CONFIG_SYSVIPC=y
-CONFIG_SYSVIPC_SYSCTL=y
-CONFIG_POSIX_MQUEUE=y
-CONFIG_POSIX_MQUEUE_SYSCTL=y
-# CONFIG_CROSS_MEMORY_ATTACH is not set
-# CONFIG_FHANDLE is not set
-# CONFIG_USELIB is not set
-# CONFIG_AUDIT is not set
-CONFIG_HAVE_ARCH_AUDITSYSCALL=y
-
-#
-# IRQ subsystem
-#
-CONFIG_GENERIC_IRQ_PROBE=y
-CONFIG_GENERIC_IRQ_SHOW=y
-CONFIG_GENERIC_IRQ_SHOW_LEVEL=y
-CONFIG_HARDIRQS_SW_RESEND=y
-CONFIG_IRQ_DOMAIN=y
-CONFIG_IRQ_DOMAIN_HIERARCHY=y
-CONFIG_HANDLE_DOMAIN_IRQ=y
-# CONFIG_IRQ_DOMAIN_DEBUG is not set
-CONFIG_IRQ_FORCED_THREADING=y
-CONFIG_SPARSE_IRQ=y
-CONFIG_ARCH_CLOCKSOURCE_DATA=y
-CONFIG_GENERIC_TIME_VSYSCALL=y
-CONFIG_GENERIC_CLOCKEVENTS=y
-
-#
-# Timers subsystem
-#
-CONFIG_TICK_ONESHOT=y
-CONFIG_NO_HZ_COMMON=y
-# CONFIG_HZ_PERIODIC is not set
-CONFIG_NO_HZ_IDLE=y
-CONFIG_NO_HZ=y
-CONFIG_HIGH_RES_TIMERS=y
-
-#
-# CPU/Task time and stats accounting
-#
-CONFIG_TICK_CPU_ACCOUNTING=y
-# CONFIG_VIRT_CPU_ACCOUNTING_GEN is not set
-# CONFIG_IRQ_TIME_ACCOUNTING is not set
-# CONFIG_BSD_PROCESS_ACCT is not set
-# CONFIG_TASKSTATS is not set
-
-#
-# RCU Subsystem
-#
-CONFIG_PREEMPT_RCU=y
-# CONFIG_RCU_EXPERT is not set
-CONFIG_SRCU=y
-# CONFIG_TASKS_RCU is not set
-CONFIG_RCU_STALL_COMMON=y
-# CONFIG_TREE_RCU_TRACE is not set
-# CONFIG_RCU_EXPEDITE_BOOT is not set
-# CONFIG_BUILD_BIN2C is not set
-# CONFIG_IKCONFIG is not set
-CONFIG_LOG_BUF_SHIFT=15
-CONFIG_NMI_LOG_BUF_SHIFT=13
-CONFIG_GENERIC_SCHED_CLOCK=y
-CONFIG_CGROUPS=y
-# CONFIG_MEMCG is not set
-# CONFIG_BLK_CGROUP is not set
-# CONFIG_CGROUP_SCHED is not set
-# CONFIG_CGROUP_PIDS is not set
-# CONFIG_CGROUP_FREEZER is not set
-# CONFIG_CPUSETS is not set
-# CONFIG_CGROUP_DEVICE is not set
-# CONFIG_CGROUP_CPUACCT is not set
-# CONFIG_CGROUP_PERF is not set
-# CONFIG_CGROUP_DEBUG is not set
-# CONFIG_CHECKPOINT_RESTORE is not set
-CONFIG_NAMESPACES=y
-CONFIG_UTS_NS=y
-CONFIG_IPC_NS=y
-# CONFIG_USER_NS is not set
-CONFIG_PID_NS=y
-CONFIG_NET_NS=y
-# CONFIG_SCHED_AUTOGROUP is not set
-# CONFIG_SYSFS_DEPRECATED is not set
-# CONFIG_RELAY is not set
-CONFIG_BLK_DEV_INITRD=y
-CONFIG_INITRAMFS_SOURCE="/src/rootfs"
-CONFIG_INITRAMFS_ROOT_UID=0
-CONFIG_INITRAMFS_ROOT_GID=0
-# CONFIG_RD_GZIP is not set
-# CONFIG_RD_BZIP2 is not set
-# CONFIG_RD_LZMA is not set
-# CONFIG_RD_XZ is not set
-# CONFIG_RD_LZO is not set
-# CONFIG_RD_LZ4 is not set
-# CONFIG_CC_OPTIMIZE_FOR_PERFORMANCE is not set
-CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-CONFIG_SYSCTL=y
-CONFIG_ANON_INODES=y
-CONFIG_HAVE_UID16=y
-CONFIG_BPF=y
-CONFIG_EXPERT=y
-CONFIG_UID16=y
-CONFIG_MULTIUSER=y
-# CONFIG_SGETMASK_SYSCALL is not set
-CONFIG_SYSFS_SYSCALL=y
-# CONFIG_SYSCTL_SYSCALL is not set
-CONFIG_KALLSYMS=y
-CONFIG_KALLSYMS_ALL=y
-# CONFIG_KALLSYMS_ABSOLUTE_PERCPU is not set
-CONFIG_KALLSYMS_BASE_RELATIVE=y
-CONFIG_PRINTK=y
-CONFIG_PRINTK_NMI=y
-CONFIG_BUG=y
-CONFIG_ELF_CORE=y
-# CONFIG_BASE_FULL is not set
-CONFIG_FUTEX=y
-CONFIG_EPOLL=y
-CONFIG_SIGNALFD=y
-CONFIG_TIMERFD=y
-CONFIG_EVENTFD=y
-# CONFIG_BPF_SYSCALL is not set
-CONFIG_SHMEM=y
-CONFIG_AIO=y
-# CONFIG_ADVISE_SYSCALLS is not set
-# CONFIG_USERFAULTFD is not set
-CONFIG_MEMBARRIER=y
-CONFIG_EMBEDDED=y
-CONFIG_HAVE_PERF_EVENTS=y
-CONFIG_PERF_USE_VMALLOC=y
-
-#
-# Kernel Performance Events And Counters
-#
-CONFIG_PERF_EVENTS=y
-# CONFIG_DEBUG_PERF_USE_VMALLOC is not set
-# CONFIG_VM_EVENT_COUNTERS is not set
-# CONFIG_SLUB_DEBUG is not set
-CONFIG_COMPAT_BRK=y
-# CONFIG_SLAB is not set
-CONFIG_SLUB=y
-# CONFIG_SLOB is not set
-# CONFIG_SLAB_FREELIST_RANDOM is not set
-# CONFIG_SYSTEM_DATA_VERIFICATION is not set
-# CONFIG_PROFILING is not set
-CONFIG_HAVE_OPROFILE=y
-# CONFIG_KPROBES is not set
-CONFIG_JUMP_LABEL=y
-# CONFIG_STATIC_KEYS_SELFTEST is not set
-# CONFIG_UPROBES is not set
-# CONFIG_HAVE_64BIT_ALIGNED_ACCESS is not set
-CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS=y
-CONFIG_ARCH_USE_BUILTIN_BSWAP=y
-CONFIG_HAVE_KPROBES=y
-CONFIG_HAVE_KRETPROBES=y
-CONFIG_HAVE_NMI=y
-CONFIG_HAVE_ARCH_TRACEHOOK=y
-CONFIG_HAVE_DMA_CONTIGUOUS=y
-CONFIG_GENERIC_SMP_IDLE_THREAD=y
-CONFIG_GENERIC_IDLE_POLL_SETUP=y
-CONFIG_HAVE_REGS_AND_STACK_ACCESS_API=y
-CONFIG_HAVE_CLK=y
-CONFIG_HAVE_DMA_API_DEBUG=y
-CONFIG_HAVE_HW_BREAKPOINT=y
-CONFIG_HAVE_PERF_REGS=y
-CONFIG_HAVE_PERF_USER_STACK_DUMP=y
-CONFIG_HAVE_ARCH_JUMP_LABEL=y
-CONFIG_ARCH_WANT_IPC_PARSE_VERSION=y
-CONFIG_HAVE_ARCH_SECCOMP_FILTER=y
-CONFIG_HAVE_GCC_PLUGINS=y
-# CONFIG_GCC_PLUGINS is not set
-CONFIG_HAVE_CC_STACKPROTECTOR=y
-CONFIG_CC_STACKPROTECTOR=y
-# CONFIG_CC_STACKPROTECTOR_NONE is not set
-CONFIG_CC_STACKPROTECTOR_REGULAR=y
-# CONFIG_CC_STACKPROTECTOR_STRONG is not set
-CONFIG_HAVE_CONTEXT_TRACKING=y
-CONFIG_HAVE_VIRT_CPU_ACCOUNTING_GEN=y
-CONFIG_HAVE_IRQ_TIME_ACCOUNTING=y
-CONFIG_HAVE_MOD_ARCH_SPECIFIC=y
-CONFIG_MODULES_USE_ELF_REL=y
-CONFIG_ARCH_HAS_ELF_RANDOMIZE=y
-CONFIG_HAVE_ARCH_MMAP_RND_BITS=y
-CONFIG_HAVE_EXIT_THREAD=y
-CONFIG_ARCH_MMAP_RND_BITS_MIN=8
-CONFIG_ARCH_MMAP_RND_BITS_MAX=16
-CONFIG_ARCH_MMAP_RND_BITS=8
-# CONFIG_HAVE_ARCH_HASH is not set
-# CONFIG_ISA_BUS_API is not set
-CONFIG_CLONE_BACKWARDS=y
-CONFIG_OLD_SIGSUSPEND3=y
-CONFIG_OLD_SIGACTION=y
-# CONFIG_CPU_NO_EFFICIENT_FFS is not set
-# CONFIG_HAVE_ARCH_VMAP_STACK is not set
-
-#
-# GCOV-based kernel profiling
-#
-# CONFIG_GCOV_KERNEL is not set
-CONFIG_ARCH_HAS_GCOV_PROFILE_ALL=y
-CONFIG_HAVE_GENERIC_DMA_COHERENT=y
-CONFIG_RT_MUTEXES=y
-CONFIG_BASE_SMALL=1
-CONFIG_MODULES=y
-CONFIG_MODULE_FORCE_LOAD=y
-CONFIG_MODULE_UNLOAD=y
-# CONFIG_MODULE_FORCE_UNLOAD is not set
-# CONFIG_MODVERSIONS is not set
-# CONFIG_MODULE_SRCVERSION_ALL is not set
-# CONFIG_MODULE_SIG is not set
-# CONFIG_MODULE_COMPRESS is not set
-# CONFIG_TRIM_UNUSED_KSYMS is not set
-CONFIG_MODULES_TREE_LOOKUP=y
-CONFIG_BLOCK=y
-# CONFIG_LBDAF is not set
-# CONFIG_BLK_DEV_BSG is not set
-# CONFIG_BLK_DEV_BSGLIB is not set
-# CONFIG_BLK_DEV_INTEGRITY is not set
-# CONFIG_BLK_CMDLINE_PARSER is not set
-
-#
-# Partition Types
-#
-# CONFIG_PARTITION_ADVANCED is not set
-CONFIG_MSDOS_PARTITION=y
-CONFIG_EFI_PARTITION=y
-
-#
-# IO Schedulers
-#
-CONFIG_IOSCHED_NOOP=y
-CONFIG_IOSCHED_DEADLINE=y
-# CONFIG_IOSCHED_CFQ is not set
-CONFIG_DEFAULT_DEADLINE=y
-# CONFIG_DEFAULT_NOOP is not set
-CONFIG_DEFAULT_IOSCHED="deadline"
-CONFIG_UNINLINE_SPIN_UNLOCK=y
-CONFIG_ARCH_SUPPORTS_ATOMIC_RMW=y
-# CONFIG_FREEZER is not set
-
-#
-# System Type
-#
-CONFIG_MMU=y
-# CONFIG_ARCH_INFINITY2 is not set
-CONFIG_ARCH_MULTIPLATFORM=y
-# CONFIG_ARCH_GEMINI is not set
-# CONFIG_ARCH_EBSA110 is not set
-# CONFIG_ARCH_EP93XX is not set
-# CONFIG_ARCH_FOOTBRIDGE is not set
-# CONFIG_ARCH_NETX is not set
-# CONFIG_ARCH_IOP13XX is not set
-# CONFIG_ARCH_IOP32X is not set
-# CONFIG_ARCH_IOP33X is not set
-# CONFIG_ARCH_IXP4XX is not set
-# CONFIG_ARCH_DOVE is not set
-# CONFIG_ARCH_KS8695 is not set
-# CONFIG_ARCH_W90X900 is not set
-# CONFIG_ARCH_LPC32XX is not set
-# CONFIG_ARCH_PXA is not set
-# CONFIG_ARCH_RPC is not set
-# CONFIG_ARCH_SA1100 is not set
-# CONFIG_ARCH_S3C24XX is not set
-# CONFIG_ARCH_DAVINCI is not set
-# CONFIG_ARCH_OMAP1 is not set
-
-#
-# Multiple platform selection
-#
-
-#
-# CPU Core family selection
-#
-# CONFIG_ARCH_MULTI_V6 is not set
-CONFIG_ARCH_MULTI_V7=y
-CONFIG_ARCH_MULTI_V6_V7=y
-# CONFIG_ARCH_MULTI_CPU_AUTO is not set
-# CONFIG_ARCH_VIRT is not set
-# CONFIG_ARCH_MVEBU is not set
-# CONFIG_ARCH_ALPINE is not set
-# CONFIG_ARCH_ARTPEC is not set
-# CONFIG_ARCH_AT91 is not set
-# CONFIG_ARCH_BCM is not set
-# CONFIG_ARCH_BERLIN is not set
-# CONFIG_ARCH_DIGICOLOR is not set
-# CONFIG_ARCH_HIGHBANK is not set
-# CONFIG_ARCH_HISI is not set
-# CONFIG_ARCH_KEYSTONE is not set
-# CONFIG_ARCH_MESON is not set
-CONFIG_ARCH_SSTAR=y
-# CONFIG_SS_DUALOS is not set
-
-#
-# Options
-#
-CONFIG_SS_DTB_NAME="infinity6b0-ssc009b-s01a"
-CONFIG_SS_BUILTIN_DTB=y
-CONFIG_MS_KERNEL_TYPE=""
-CONFIG_SSTAR_CHIP_NAME="infinity6b0"
-CONFIG_SSTAR_SHORT_NAME="I6B0"
-# CONFIG_MP_IRQ_TRACE is not set
-CONFIG_SKIP_SQUASHFS_BAD_BLOCK=y
-
-#
-# Fast boot
-#
-# CONFIG_SS_BUILTIN_UNFDT is not set
-# CONFIG_FB_DTS_SKIP_CRC is not set
-# CONFIG_FB_DTS_SCAN_MEMORY_ONCE is not set
-# CONFIG_FB_DTS_SKIP_ATAGS_TO_FDT is not set
-CONFIG_DISABLE_CLK_DEBUGFS_SUPPORT=y
-CONFIG_DEFERRED_INIICALLS=y
-# CONFIG_DEFERRED_INIICALLS_SLAB_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_PARAM_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_PPERF_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_MORE_SYSFS is not set
-# CONFIG_DEFERRED_CREATE_DTS_SYSNODE is not set
-# CONFIG_CRYPTO_MANAGER_NO_TESTS_THREAD is not set
-CONFIG_ARCH_INFINITY6B0=y
-CONFIG_SS_PROFILING_TIME=y
-# CONFIG_ARCH_MXC is not set
-# CONFIG_ARCH_MEDIATEK is not set
-
-#
-# TI OMAP/AM/DM/DRA Family
-#
-# CONFIG_ARCH_OMAP3 is not set
-# CONFIG_ARCH_OMAP4 is not set
-# CONFIG_SOC_OMAP5 is not set
-# CONFIG_SOC_AM33XX is not set
-# CONFIG_SOC_AM43XX is not set
-# CONFIG_SOC_DRA7XX is not set
-# CONFIG_ARCH_MMP is not set
-# CONFIG_ARCH_QCOM is not set
-# CONFIG_ARCH_REALVIEW is not set
-# CONFIG_ARCH_ROCKCHIP is not set
-# CONFIG_ARCH_SOCFPGA is not set
-# CONFIG_PLAT_SPEAR is not set
-# CONFIG_ARCH_STI is not set
-# CONFIG_ARCH_S5PV210 is not set
-# CONFIG_ARCH_EXYNOS is not set
-# CONFIG_ARCH_RENESAS is not set
-# CONFIG_ARCH_SUNXI is not set
-# CONFIG_ARCH_SIRF is not set
-# CONFIG_ARCH_TANGO is not set
-# CONFIG_ARCH_TEGRA is not set
-# CONFIG_ARCH_UNIPHIER is not set
-# CONFIG_ARCH_U8500 is not set
-# CONFIG_ARCH_VEXPRESS is not set
-# CONFIG_ARCH_WM8850 is not set
-# CONFIG_ARCH_ZX is not set
-# CONFIG_ARCH_ZYNQ is not set
-
-#
-# Processor Type
-#
-CONFIG_CPU_V7=y
-CONFIG_CPU_32v6K=y
-CONFIG_CPU_32v7=y
-CONFIG_CPU_ABRT_EV7=y
-CONFIG_CPU_PABRT_V7=y
-CONFIG_CPU_CACHE_V7=y
-CONFIG_CPU_CACHE_VIPT=y
-CONFIG_CPU_COPY_V6=y
-CONFIG_CPU_TLB_V7=y
-CONFIG_CPU_HAS_ASID=y
-CONFIG_CPU_CP15=y
-CONFIG_CPU_CP15_MMU=y
-
-#
-# Processor Features
-#
-# CONFIG_ARM_LPAE is not set
-# CONFIG_ARCH_PHYS_ADDR_T_64BIT is not set
-CONFIG_ARM_THUMB=y
-CONFIG_ARM_THUMBEE=y
-CONFIG_ARM_VIRT_EXT=y
-# CONFIG_SWP_EMULATE is not set
-# CONFIG_CPU_ICACHE_DISABLE is not set
-# CONFIG_CPU_DCACHE_DISABLE is not set
-# CONFIG_CPU_BPREDICT_DISABLE is not set
-CONFIG_KUSER_HELPERS=y
-CONFIG_VDSO=y
-CONFIG_MIGHT_HAVE_CACHE_L2X0=y
-# CONFIG_CACHE_L2X0 is not set
-CONFIG_ARM_L1_CACHE_SHIFT_6=y
-CONFIG_ARM_L1_CACHE_SHIFT=6
-CONFIG_ARM_DMA_MEM_BUFFERABLE=y
-# CONFIG_DEBUG_RODATA is not set
-CONFIG_MULTI_IRQ_HANDLER=y
-# CONFIG_ARM_ERRATA_430973 is not set
-# CONFIG_ARM_ERRATA_720789 is not set
-# CONFIG_ARM_ERRATA_754322 is not set
-# CONFIG_ARM_ERRATA_775420 is not set
-# CONFIG_ARM_ERRATA_773022 is not set
-# CONFIG_ARM_ERRATA_818325_852422 is not set
-# CONFIG_ARM_ERRATA_821420 is not set
-# CONFIG_ARM_ERRATA_825619 is not set
-# CONFIG_ARM_ERRATA_852421 is not set
-# CONFIG_ARM_ERRATA_852423 is not set
-
-#
-# Bus support
-#
-# CONFIG_PCI is not set
-# CONFIG_PCI_DOMAINS_GENERIC is not set
-# CONFIG_PCI_SYSCALL is not set
-# CONFIG_PCCARD is not set
-
-#
-# Kernel Features
-#
-CONFIG_HAVE_SMP=y
-# CONFIG_SMP is not set
-CONFIG_HAVE_ARM_ARCH_TIMER=y
-CONFIG_VMSPLIT_3G=y
-# CONFIG_VMSPLIT_3G_OPT is not set
-# CONFIG_VMSPLIT_2G is not set
-# CONFIG_VMSPLIT_1G is not set
-CONFIG_PAGE_OFFSET=0xC0000000
-# CONFIG_ARM_PSCI is not set
-CONFIG_ARCH_NR_GPIO=0
-# CONFIG_PREEMPT_NONE is not set
-# CONFIG_PREEMPT_VOLUNTARY is not set
-CONFIG_PREEMPT=y
-CONFIG_PREEMPT_COUNT=y
-CONFIG_HZ_FIXED=0
-CONFIG_HZ_100=y
-# CONFIG_HZ_200 is not set
-# CONFIG_HZ_250 is not set
-# CONFIG_HZ_300 is not set
-# CONFIG_HZ_500 is not set
-# CONFIG_HZ_1000 is not set
-CONFIG_HZ=100
-CONFIG_SCHED_HRTICK=y
-CONFIG_THUMB2_KERNEL=y
-CONFIG_THUMB2_AVOID_R_ARM_THM_JUMP11=y
-CONFIG_ARM_ASM_UNIFIED=y
-CONFIG_ARM_PATCH_IDIV=y
-CONFIG_AEABI=y
-# CONFIG_ARCH_SPARSEMEM_DEFAULT is not set
-# CONFIG_ARCH_SELECT_MEMORY_MODEL is not set
-CONFIG_HAVE_ARCH_PFN_VALID=y
-# CONFIG_HIGHMEM is not set
-CONFIG_CPU_SW_DOMAIN_PAN=y
-CONFIG_HW_PERF_EVENTS=y
-CONFIG_ARCH_WANT_GENERAL_HUGETLB=y
-# CONFIG_ARM_MODULE_PLTS is not set
-CONFIG_FLATMEM=y
-CONFIG_FLAT_NODE_MEM_MAP=y
-CONFIG_HAVE_MEMBLOCK=y
-CONFIG_NO_BOOTMEM=y
-CONFIG_MEMORY_ISOLATION=y
-# CONFIG_HAVE_BOOTMEM_INFO_NODE is not set
-CONFIG_SPLIT_PTLOCK_CPUS=4
-CONFIG_COMPACTION=y
-CONFIG_MIGRATION=y
-# CONFIG_PHYS_ADDR_T_64BIT is not set
-# CONFIG_KSM is not set
-CONFIG_DEFAULT_MMAP_MIN_ADDR=4096
-CONFIG_NEED_PER_CPU_KM=y
-# CONFIG_CLEANCACHE is not set
-CONFIG_CMA=y
-CONFIG_CMA_DEBUG=y
-CONFIG_CMA_DEBUGFS=y
-CONFIG_CMA_AREAS=1
-# CONFIG_ZPOOL is not set
-# CONFIG_ZBUD is not set
-# CONFIG_ZSMALLOC is not set
-CONFIG_GENERIC_EARLY_IOREMAP=y
-# CONFIG_IDLE_PAGE_TRACKING is not set
-CONFIG_FORCE_MAX_ZONEORDER=10
-CONFIG_ALIGNMENT_TRAP=y
-# CONFIG_UACCESS_WITH_MEMCPY is not set
-# CONFIG_SECCOMP is not set
-CONFIG_SWIOTLB=y
-CONFIG_IOMMU_HELPER=y
-# CONFIG_PARAVIRT is not set
-# CONFIG_PARAVIRT_TIME_ACCOUNTING is not set
-# CONFIG_XEN is not set
-
-#
-# Boot options
-#
-CONFIG_USE_OF=y
-CONFIG_ATAGS=y
-# CONFIG_DEPRECATED_PARAM_STRUCT is not set
-CONFIG_ZBOOT_ROM_TEXT=0
-CONFIG_ZBOOT_ROM_BSS=0
-CONFIG_ARM_APPENDED_DTB=y
-CONFIG_ARM_ATAG_DTB_COMPAT=y
-CONFIG_ARM_ATAG_DTB_COMPAT_CMDLINE_FROM_BOOTLOADER=y
-# CONFIG_ARM_ATAG_DTB_COMPAT_CMDLINE_EXTEND is not set
-CONFIG_CMDLINE=""
-# CONFIG_KEXEC is not set
-# CONFIG_CRASH_DUMP is not set
-CONFIG_AUTO_ZRELADDR=y
-# CONFIG_EFI is not set
-
-#
-# CPU Power Management
-#
-
-#
-# CPU Frequency scaling
-#
-CONFIG_CPU_FREQ=y
-CONFIG_CPU_FREQ_GOV_ATTR_SET=y
-CONFIG_CPU_FREQ_GOV_COMMON=y
-CONFIG_CPU_FREQ_STAT=y
-CONFIG_CPU_FREQ_STAT_DETAILS=y
-# CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE is not set
-# CONFIG_CPU_FREQ_DEFAULT_GOV_POWERSAVE is not set
-# CONFIG_CPU_FREQ_DEFAULT_GOV_USERSPACE is not set
-CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND=y
-# CONFIG_CPU_FREQ_DEFAULT_GOV_CONSERVATIVE is not set
-CONFIG_CPU_FREQ_GOV_PERFORMANCE=y
-CONFIG_CPU_FREQ_GOV_POWERSAVE=y
-CONFIG_CPU_FREQ_GOV_USERSPACE=y
-CONFIG_CPU_FREQ_GOV_ONDEMAND=y
-# CONFIG_CPU_FREQ_GOV_CONSERVATIVE is not set
-
-#
-# CPU frequency scaling drivers
-#
-# CONFIG_CPUFREQ_DT is not set
-# CONFIG_ARM_KIRKWOOD_CPUFREQ is not set
-# CONFIG_QORIQ_CPUFREQ is not set
-
-#
-# CPU Idle
-#
-# CONFIG_CPU_IDLE is not set
-# CONFIG_ARCH_NEEDS_CPU_IDLE_COUPLED is not set
-
-#
-# Floating point emulation
-#
-
-#
-# At least one emulation must be selected
-#
-CONFIG_VFP=y
-CONFIG_VFPv3=y
-CONFIG_NEON=y
-CONFIG_KERNEL_MODE_NEON=y
-
-#
-# Userspace binary formats
-#
-CONFIG_BINFMT_ELF=y
-CONFIG_ELFCORE=y
-CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS=y
-CONFIG_BINFMT_SCRIPT=y
-# CONFIG_BINFMT_FLAT is not set
-# CONFIG_HAVE_AOUT is not set
-# CONFIG_BINFMT_MISC is not set
-CONFIG_COREDUMP=y
-
-#
-# Power management options
-#
-# CONFIG_SUSPEND is not set
-# CONFIG_PM is not set
-# CONFIG_APM_EMULATION is not set
-CONFIG_PM_OPP=y
-CONFIG_ARCH_SUSPEND_POSSIBLE=y
-# CONFIG_ARM_CPU_SUSPEND is not set
-CONFIG_ARCH_HIBERNATION_POSSIBLE=y
-CONFIG_NET=y
-
-#
-# Networking options
-#
-CONFIG_PACKET=y
-# CONFIG_PACKET_DIAG is not set
-CONFIG_UNIX=y
-# CONFIG_UNIX_DIAG is not set
-# CONFIG_XFRM_USER is not set
-# CONFIG_NET_KEY is not set
-CONFIG_INET=y
-CONFIG_IP_MULTICAST=y
-CONFIG_IP_ADVANCED_ROUTER=y
-# CONFIG_IP_FIB_TRIE_STATS is not set
-# CONFIG_IP_MULTIPLE_TABLES is not set
-CONFIG_IP_ROUTE_MULTIPATH=y
-CONFIG_IP_ROUTE_VERBOSE=y
-# CONFIG_IP_PNP is not set
-# CONFIG_NET_IPIP is not set
-# CONFIG_NET_IPGRE_DEMUX is not set
-# CONFIG_NET_IP_TUNNEL is not set
-# CONFIG_IP_MROUTE is not set
-CONFIG_SYN_COOKIES=y
-# CONFIG_NET_UDP_TUNNEL is not set
-# CONFIG_NET_FOU is not set
-# CONFIG_INET_AH is not set
-# CONFIG_INET_ESP is not set
-# CONFIG_INET_IPCOMP is not set
-# CONFIG_INET_XFRM_TUNNEL is not set
-# CONFIG_INET_TUNNEL is not set
-# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-# CONFIG_INET_XFRM_MODE_BEET is not set
-# CONFIG_INET_DIAG is not set
-CONFIG_TCP_CONG_ADVANCED=y
-# CONFIG_TCP_CONG_BIC is not set
-CONFIG_TCP_CONG_CUBIC=y
-# CONFIG_TCP_CONG_WESTWOOD is not set
-# CONFIG_TCP_CONG_HTCP is not set
-# CONFIG_TCP_CONG_HSTCP is not set
-# CONFIG_TCP_CONG_HYBLA is not set
-# CONFIG_TCP_CONG_VEGAS is not set
-# CONFIG_TCP_CONG_NV is not set
-# CONFIG_TCP_CONG_SCALABLE is not set
-# CONFIG_TCP_CONG_LP is not set
-# CONFIG_TCP_CONG_VENO is not set
-# CONFIG_TCP_CONG_YEAH is not set
-# CONFIG_TCP_CONG_ILLINOIS is not set
-# CONFIG_TCP_CONG_DCTCP is not set
-# CONFIG_TCP_CONG_CDG is not set
-# CONFIG_TCP_CONG_BBR is not set
-CONFIG_DEFAULT_CUBIC=y
-# CONFIG_DEFAULT_RENO is not set
-CONFIG_DEFAULT_TCP_CONG="cubic"
-# CONFIG_TCP_MD5SIG is not set
-# CONFIG_IPV6 is not set
-# CONFIG_NETWORK_SECMARK is not set
-# CONFIG_NET_PTP_CLASSIFY is not set
-# CONFIG_NETWORK_PHY_TIMESTAMPING is not set
-# CONFIG_NETFILTER is not set
-# CONFIG_IP_DCCP is not set
-# CONFIG_IP_SCTP is not set
-# CONFIG_RDS is not set
-# CONFIG_TIPC is not set
-# CONFIG_ATM is not set
-# CONFIG_L2TP is not set
-CONFIG_BRIDGE=y
-CONFIG_HAVE_NET_DSA=y
-# CONFIG_NET_DSA is not set
-# CONFIG_VLAN_8021Q is not set
-# CONFIG_DECNET is not set
-# CONFIG_LLC2 is not set
-# CONFIG_IPX is not set
-# CONFIG_ATALK is not set
-# CONFIG_X25 is not set
-# CONFIG_LAPB is not set
-# CONFIG_PHONET is not set
-# CONFIG_IEEE802154 is not set
-# CONFIG_NET_SCHED is not set
-# CONFIG_DCB is not set
-CONFIG_DNS_RESOLVER=y
-# CONFIG_BATMAN_ADV is not set
-# CONFIG_OPENVSWITCH is not set
-# CONFIG_VSOCKETS is not set
-# CONFIG_NETLINK_DIAG is not set
-# CONFIG_MPLS is not set
-# CONFIG_HSR is not set
-# CONFIG_NET_SWITCHDEV is not set
-# CONFIG_NET_L3_MASTER_DEV is not set
-# CONFIG_NET_NCSI is not set
-# CONFIG_SOCK_CGROUP_DATA is not set
-# CONFIG_CGROUP_NET_PRIO is not set
-# CONFIG_CGROUP_NET_CLASSID is not set
-CONFIG_NET_RX_BUSY_POLL=y
-CONFIG_BQL=y
-# CONFIG_BPF_JIT is not set
-
-#
-# Network testing
-#
-# CONFIG_NET_PKTGEN is not set
-# CONFIG_HAMRADIO is not set
-# CONFIG_CAN is not set
-# CONFIG_IRDA is not set
-# CONFIG_BT is not set
-# CONFIG_AF_RXRPC is not set
-# CONFIG_AF_KCM is not set
-# CONFIG_STREAM_PARSER is not set
-CONFIG_WIRELESS=y
-CONFIG_WIRELESS_EXT=y
-CONFIG_WEXT_CORE=y
-CONFIG_WEXT_PROC=y
-CONFIG_WEXT_PRIV=y
-CONFIG_CFG80211=y
-# CONFIG_NL80211_TESTMODE is not set
-# CONFIG_CFG80211_DEVELOPER_WARNINGS is not set
-# CONFIG_CFG80211_CERTIFICATION_ONUS is not set
-CONFIG_CFG80211_DEFAULT_PS=y
-# CONFIG_CFG80211_DEBUGFS is not set
-# CONFIG_CFG80211_INTERNAL_REGDB is not set
-CONFIG_CFG80211_CRDA_SUPPORT=y
-CONFIG_CFG80211_WEXT=y
-# CONFIG_LIB80211 is not set
-# CONFIG_MAC80211 is not set
-CONFIG_MAC80211_STA_HASH_MAX_SIZE=0
-# CONFIG_WIMAX is not set
-# CONFIG_RFKILL is not set
-# CONFIG_NET_9P is not set
-# CONFIG_CAIF is not set
-# CONFIG_CEPH_LIB is not set
-# CONFIG_NFC is not set
-# CONFIG_LWTUNNEL is not set
-# CONFIG_DST_CACHE is not set
-# CONFIG_NET_DEVLINK is not set
-CONFIG_MAY_USE_DEVLINK=y
-CONFIG_HAVE_CBPF_JIT=y
-
-#
-# Device Drivers
-#
-
-#
-# Generic Driver Options
-#
-CONFIG_UEVENT_HELPER=y
-CONFIG_UEVENT_HELPER_PATH="/sbin/mdev"
-CONFIG_DEVTMPFS=y
-CONFIG_DEVTMPFS_MOUNT=y
-# CONFIG_STANDALONE is not set
-# CONFIG_PREVENT_FIRMWARE_BUILD is not set
-# CONFIG_FW_LOADER is not set
-# CONFIG_ALLOW_DEV_COREDUMP is not set
-# CONFIG_DEBUG_DRIVER is not set
-# CONFIG_DEBUG_DEVRES is not set
-# CONFIG_DEBUG_TEST_DRIVER_REMOVE is not set
-# CONFIG_SYS_HYPERVISOR is not set
-# CONFIG_GENERIC_CPU_DEVICES is not set
-CONFIG_SOC_BUS=y
-CONFIG_REGMAP=y
-CONFIG_REGMAP_I2C=y
-CONFIG_REGMAP_SPI=y
-# CONFIG_DMA_SHARED_BUFFER is not set
-CONFIG_DMA_CMA=y
-
-#
-# Default contiguous memory area size:
-#
-CONFIG_CMA_SIZE_MBYTES=2
-CONFIG_CMA_SIZE_SEL_MBYTES=y
-# CONFIG_CMA_SIZE_SEL_PERCENTAGE is not set
-# CONFIG_CMA_SIZE_SEL_MIN is not set
-# CONFIG_CMA_SIZE_SEL_MAX is not set
-CONFIG_CMA_ALIGNMENT=4
-
-#
-# Bus devices
-#
-# CONFIG_ARM_CCI400_PMU is not set
-# CONFIG_ARM_CCI5xx_PMU is not set
-# CONFIG_ARM_CCN is not set
-# CONFIG_BRCMSTB_GISB_ARB is not set
-# CONFIG_VEXPRESS_CONFIG is not set
-# CONFIG_CONNECTOR is not set
-CONFIG_MTD=y
-# CONFIG_MTD_TESTS is not set
-# CONFIG_MTD_REDBOOT_PARTS is not set
-CONFIG_MTD_CMDLINE_PARTS=y
-# CONFIG_MTD_AFS_PARTS is not set
-# CONFIG_MTD_OF_PARTS is not set
-# CONFIG_MTD_AR7_PARTS is not set
-
-#
-# User Modules And Translation Layers
-#
-CONFIG_MTD_BLKDEVS=y
-CONFIG_MTD_BLOCK=y
-# CONFIG_FTL is not set
-# CONFIG_NFTL is not set
-# CONFIG_INFTL is not set
-# CONFIG_RFD_FTL is not set
-# CONFIG_SSFDC is not set
-# CONFIG_SM_FTL is not set
-# CONFIG_MTD_OOPS is not set
-# CONFIG_MTD_PARTITIONED_MASTER is not set
-
-#
-# RAM/ROM/Flash chip drivers
-#
-# CONFIG_MTD_CFI is not set
-# CONFIG_MTD_JEDECPROBE is not set
-CONFIG_MTD_MAP_BANK_WIDTH_1=y
-CONFIG_MTD_MAP_BANK_WIDTH_2=y
-CONFIG_MTD_MAP_BANK_WIDTH_4=y
-# CONFIG_MTD_MAP_BANK_WIDTH_8 is not set
-# CONFIG_MTD_MAP_BANK_WIDTH_16 is not set
-# CONFIG_MTD_MAP_BANK_WIDTH_32 is not set
-CONFIG_MTD_CFI_I1=y
-CONFIG_MTD_CFI_I2=y
-# CONFIG_MTD_CFI_I4 is not set
-# CONFIG_MTD_CFI_I8 is not set
-CONFIG_MTD_RAM=y
-# CONFIG_MTD_ROM is not set
-# CONFIG_MTD_ABSENT is not set
-
-#
-# Mapping drivers for chip access
-#
-# CONFIG_MTD_COMPLEX_MAPPINGS is not set
-CONFIG_MTD_PHYSMAP_OF=y
-CONFIG_MTD_PLATRAM=y
-
-#
-# Self-contained MTD device drivers
-#
-# CONFIG_MTD_DATAFLASH is not set
-# CONFIG_MTD_M25P80 is not set
-# CONFIG_MTD_SST25L is not set
-# CONFIG_MTD_SLRAM is not set
-# CONFIG_MTD_PHRAM is not set
-# CONFIG_MTD_MTDRAM is not set
-# CONFIG_MTD_BLOCK2MTD is not set
-
-#
-# Disk-On-Chip Device Drivers
-#
-# CONFIG_MTD_DOCG3 is not set
-CONFIG_MTD_NAND_ECC=y
-# CONFIG_MTD_NAND_ECC_SMC is not set
-CONFIG_MTD_NAND=y
-# CONFIG_MTD_NAND_ECC_BCH is not set
-# CONFIG_MTD_SM_COMMON is not set
-# CONFIG_MTD_NAND_DENALI_DT is not set
-# CONFIG_MTD_NAND_GPIO is not set
-# CONFIG_MTD_NAND_OMAP_BCH_BUILD is not set
-CONFIG_MTD_NAND_IDS=y
-# CONFIG_MTD_NAND_DISKONCHIP is not set
-# CONFIG_MTD_NAND_DOCG4 is not set
-# CONFIG_MTD_NAND_NANDSIM is not set
-# CONFIG_MTD_NAND_BRCMNAND is not set
-# CONFIG_MTD_NAND_PLATFORM is not set
-# CONFIG_MTD_NAND_HISI504 is not set
-# CONFIG_MTD_NAND_MTK is not set
-# CONFIG_MTD_ONENAND is not set
-
-#
-# LPDDR & LPDDR2 PCM memory drivers
-#
-# CONFIG_MTD_LPDDR is not set
-# CONFIG_MTD_LPDDR2_NVM is not set
-CONFIG_MTD_SPI_NOR=y
-# CONFIG_MTD_MT81xx_NOR is not set
-CONFIG_MTD_SPI_NOR_USE_4K_SECTORS=y
-# CONFIG_SPI_CADENCE_QUADSPI is not set
-CONFIG_MTD_UBI=y
-CONFIG_MTD_UBI_WL_THRESHOLD=4096
-CONFIG_MTD_UBI_BEB_LIMIT=20
-# CONFIG_MTD_UBI_FASTMAP is not set
-# CONFIG_MTD_UBI_GLUEBI is not set
-# CONFIG_MTD_UBI_BLOCK is not set
-CONFIG_DTC=y
-CONFIG_OF=y
-# CONFIG_OF_UNITTEST is not set
-CONFIG_OF_FLATTREE=y
-CONFIG_OF_EARLY_FLATTREE=y
-CONFIG_OF_ADDRESS=y
-CONFIG_OF_IRQ=y
-CONFIG_OF_NET=y
-CONFIG_OF_MDIO=y
-CONFIG_OF_RESERVED_MEM=y
-# CONFIG_OF_OVERLAY is not set
-CONFIG_ARCH_MIGHT_HAVE_PC_PARPORT=y
-# CONFIG_PARPORT is not set
-CONFIG_BLK_DEV=y
-# CONFIG_BLK_DEV_NULL_BLK is not set
-# CONFIG_BLK_DEV_COW_COMMON is not set
-CONFIG_BLK_DEV_LOOP=y
-# CONFIG_BLK_DEV_DRBD is not set
-# CONFIG_BLK_DEV_NBD is not set
-CONFIG_BLK_DEV_RAM=y
-CONFIG_BLK_DEV_RAM_COUNT=16
-CONFIG_BLK_DEV_RAM_SIZE=65536
-# CONFIG_CDROM_PKTCDVD is not set
-# CONFIG_ATA_OVER_ETH is not set
-# CONFIG_MG_DISK is not set
-# CONFIG_BLK_DEV_RBD is not set
-# CONFIG_NVME_TARGET is not set
-
-#
-# Misc devices
-#
-# CONFIG_AD525X_DPOT is not set
-# CONFIG_DUMMY_IRQ is not set
-# CONFIG_ICS932S401 is not set
-# CONFIG_ENCLOSURE_SERVICES is not set
-# CONFIG_APDS9802ALS is not set
-# CONFIG_ISL29003 is not set
-# CONFIG_ISL29020 is not set
-# CONFIG_SENSORS_TSL2550 is not set
-# CONFIG_SENSORS_BH1770 is not set
-# CONFIG_SENSORS_APDS990X is not set
-# CONFIG_HMC6352 is not set
-# CONFIG_DS1682 is not set
-# CONFIG_TI_DAC7512 is not set
-# CONFIG_USB_SWITCH_FSA9480 is not set
-# CONFIG_LATTICE_ECP3_CONFIG is not set
-# CONFIG_SRAM is not set
-# CONFIG_C2PORT is not set
-
-#
-# EEPROM support
-#
-# CONFIG_EEPROM_AT24 is not set
-# CONFIG_EEPROM_AT25 is not set
-# CONFIG_EEPROM_LEGACY is not set
-# CONFIG_EEPROM_MAX6875 is not set
-# CONFIG_EEPROM_93CX6 is not set
-# CONFIG_EEPROM_93XX46 is not set
-
-#
-# Texas Instruments shared transport line discipline
-#
-# CONFIG_TI_ST is not set
-
-#
-# Altera FPGA firmware download module
-#
-# CONFIG_ALTERA_STAPL is not set
-
-#
-# Intel MIC Bus Driver
-#
-
-#
-# SCIF Bus Driver
-#
-
-#
-# VOP Bus Driver
-#
-
-#
-# Intel MIC Host Driver
-#
-
-#
-# Intel MIC Card Driver
-#
-
-#
-# SCIF Driver
-#
-
-#
-# Intel MIC Coprocessor State Management (COSM) Drivers
-#
-
-#
-# VOP Driver
-#
-# CONFIG_ECHO is not set
-# CONFIG_CXL_BASE is not set
-# CONFIG_CXL_AFU_DRIVER_OPS is not set
-
-#
-# SCSI device support
-#
-CONFIG_SCSI_MOD=m
-# CONFIG_RAID_ATTRS is not set
-CONFIG_SCSI=m
-CONFIG_SCSI_DMA=y
-# CONFIG_SCSI_NETLINK is not set
-# CONFIG_SCSI_MQ_DEFAULT is not set
-CONFIG_SCSI_PROC_FS=y
-
-#
-# SCSI support type (disk, tape, CD-ROM)
-#
-CONFIG_BLK_DEV_SD=m
-# CONFIG_CHR_DEV_ST is not set
-# CONFIG_CHR_DEV_OSST is not set
-# CONFIG_BLK_DEV_SR is not set
-# CONFIG_CHR_DEV_SG is not set
-# CONFIG_CHR_DEV_SCH is not set
-# CONFIG_SCSI_CONSTANTS is not set
-# CONFIG_SCSI_LOGGING is not set
-# CONFIG_SCSI_SCAN_ASYNC is not set
-
-#
-# SCSI Transports
-#
-# CONFIG_SCSI_SPI_ATTRS is not set
-# CONFIG_SCSI_FC_ATTRS is not set
-# CONFIG_SCSI_ISCSI_ATTRS is not set
-# CONFIG_SCSI_SAS_ATTRS is not set
-# CONFIG_SCSI_SAS_LIBSAS is not set
-# CONFIG_SCSI_SRP_ATTRS is not set
-CONFIG_SCSI_LOWLEVEL=y
-# CONFIG_ISCSI_TCP is not set
-# CONFIG_ISCSI_BOOT_SYSFS is not set
-# CONFIG_SCSI_UFSHCD is not set
-# CONFIG_SCSI_DEBUG is not set
-# CONFIG_SCSI_DH is not set
-# CONFIG_SCSI_OSD_INITIATOR is not set
-# CONFIG_ATA is not set
-# CONFIG_MD is not set
-# CONFIG_TARGET_CORE is not set
-CONFIG_NETDEVICES=y
-CONFIG_MII=y
-# CONFIG_NET_CORE is not set
-
-#
-# CAIF transport drivers
-#
-
-#
-# Distributed Switch Architecture drivers
-#
-# CONFIG_ETHERNET is not set
-CONFIG_PHYLIB=y
-CONFIG_SWPHY=y
-
-#
-# MDIO bus device drivers
-#
-# CONFIG_MDIO_BCM_UNIMAC is not set
-# CONFIG_MDIO_BITBANG is not set
-# CONFIG_MDIO_BUS_MUX_GPIO is not set
-# CONFIG_MDIO_BUS_MUX_MMIOREG is not set
-# CONFIG_MDIO_HISI_FEMAC is not set
-
-#
-# MII PHY device drivers
-#
-# CONFIG_AMD_PHY is not set
-# CONFIG_AQUANTIA_PHY is not set
-# CONFIG_AT803X_PHY is not set
-# CONFIG_BCM7XXX_PHY is not set
-# CONFIG_BCM87XX_PHY is not set
-# CONFIG_BROADCOM_PHY is not set
-# CONFIG_CICADA_PHY is not set
-# CONFIG_DAVICOM_PHY is not set
-# CONFIG_DP83848_PHY is not set
-# CONFIG_DP83867_PHY is not set
-CONFIG_FIXED_PHY=y
-# CONFIG_ICPLUS_PHY is not set
-# CONFIG_INTEL_XWAY_PHY is not set
-# CONFIG_LSI_ET1011C_PHY is not set
-# CONFIG_LXT_PHY is not set
-# CONFIG_MARVELL_PHY is not set
-# CONFIG_MICREL_PHY is not set
-# CONFIG_MICROCHIP_PHY is not set
-# CONFIG_MICROSEMI_PHY is not set
-# CONFIG_NATIONAL_PHY is not set
-# CONFIG_QSEMI_PHY is not set
-# CONFIG_REALTEK_PHY is not set
-# CONFIG_SMSC_PHY is not set
-# CONFIG_STE10XP is not set
-# CONFIG_TERANETICS_PHY is not set
-# CONFIG_VITESSE_PHY is not set
-# CONFIG_XILINX_GMII2RGMII is not set
-# CONFIG_MICREL_KS8995MA is not set
-# CONFIG_PPP is not set
-# CONFIG_SLIP is not set
-# CONFIG_USB_NET_DRIVERS is not set
-CONFIG_WLAN=y
-CONFIG_WLAN_VENDOR_ADMTEK=y
-CONFIG_WLAN_VENDOR_ATH=y
-# CONFIG_ATH_DEBUG is not set
-# CONFIG_ATH6KL is not set
-CONFIG_WLAN_VENDOR_ATMEL=y
-CONFIG_WLAN_VENDOR_BROADCOM=y
-# CONFIG_BRCMFMAC is not set
-CONFIG_WLAN_VENDOR_CISCO=y
-CONFIG_WLAN_VENDOR_INTEL=y
-CONFIG_WLAN_VENDOR_INTERSIL=y
-# CONFIG_HOSTAP is not set
-CONFIG_WLAN_VENDOR_MARVELL=y
-# CONFIG_LIBERTAS is not set
-# CONFIG_MWIFIEX is not set
-CONFIG_WLAN_VENDOR_MEDIATEK=y
-CONFIG_WLAN_VENDOR_RALINK=y
-CONFIG_WLAN_VENDOR_REALTEK=y
-CONFIG_WLAN_VENDOR_RSI=y
-CONFIG_WLAN_VENDOR_ST=y
-CONFIG_WLAN_VENDOR_TI=y
-CONFIG_WLAN_VENDOR_ZYDAS=y
-# CONFIG_USB_ZD1201 is not set
-# CONFIG_USB_NET_RNDIS_WLAN is not set
-
-#
-# Enable WiMAX (Networking options) to see the WiMAX drivers
-#
-# CONFIG_WAN is not set
-# CONFIG_ISDN is not set
-# CONFIG_NVM is not set
-
-#
-# Input device support
-#
-# CONFIG_INPUT is not set
-
-#
-# Hardware I/O ports
-#
-# CONFIG_SERIO is not set
-# CONFIG_GAMEPORT is not set
-
-#
-# Character devices
-#
-CONFIG_TTY=y
-# CONFIG_VT is not set
-CONFIG_UNIX98_PTYS=y
-# CONFIG_LEGACY_PTYS is not set
-# CONFIG_SERIAL_NONSTANDARD is not set
-# CONFIG_N_GSM is not set
-# CONFIG_TRACE_SINK is not set
-CONFIG_DEVMEM=y
-# CONFIG_DEVKMEM is not set
-
-#
-# Serial drivers
-#
-# CONFIG_SERIAL_8250 is not set
-
-#
-# Non-8250 serial port support
-#
-# CONFIG_SERIAL_EARLYCON_ARM_SEMIHOST is not set
-# CONFIG_SERIAL_MAX3100 is not set
-# CONFIG_SERIAL_MAX310X is not set
-# CONFIG_SERIAL_UARTLITE is not set
-CONFIG_SERIAL_CORE=y
-CONFIG_SERIAL_CORE_CONSOLE=y
-# CONFIG_SERIAL_SCCNXP is not set
-# CONFIG_SERIAL_SC16IS7XX is not set
-# CONFIG_SERIAL_BCM63XX is not set
-# CONFIG_SERIAL_ALTERA_JTAGUART is not set
-# CONFIG_SERIAL_ALTERA_UART is not set
-# CONFIG_SERIAL_IFX6X60 is not set
-# CONFIG_SERIAL_XILINX_PS_UART is not set
-# CONFIG_SERIAL_ARC is not set
-# CONFIG_SERIAL_FSL_LPUART is not set
-# CONFIG_SERIAL_CONEXANT_DIGICOLOR is not set
-# CONFIG_SERIAL_ST_ASC is not set
-# CONFIG_SERIAL_STM32 is not set
-# CONFIG_TTY_PRINTK is not set
-# CONFIG_HVC_DCC is not set
-# CONFIG_IPMI_HANDLER is not set
-# CONFIG_HW_RANDOM is not set
-# CONFIG_R3964 is not set
-# CONFIG_RAW_DRIVER is not set
-# CONFIG_TCG_TPM is not set
-# CONFIG_XILLYBUS is not set
-
-#
-# I2C support
-#
-CONFIG_I2C=y
-CONFIG_I2C_BOARDINFO=y
-# CONFIG_I2C_COMPAT is not set
-CONFIG_I2C_CHARDEV=y
-# CONFIG_I2C_MUX is not set
-# CONFIG_I2C_HELPER_AUTO is not set
-# CONFIG_I2C_SMBUS is not set
-
-#
-# I2C Algorithms
-#
-# CONFIG_I2C_ALGOBIT is not set
-# CONFIG_I2C_ALGOPCF is not set
-# CONFIG_I2C_ALGOPCA is not set
-
-#
-# I2C Hardware Bus support
-#
-
-#
-# I2C system bus drivers (mostly embedded / system-on-chip)
-#
-# CONFIG_I2C_CBUS_GPIO is not set
-# CONFIG_I2C_DESIGNWARE_PLATFORM is not set
-# CONFIG_I2C_EMEV2 is not set
-# CONFIG_I2C_GPIO is not set
-# CONFIG_I2C_OCORES is not set
-# CONFIG_I2C_PCA_PLATFORM is not set
-# CONFIG_I2C_PXA_PCI is not set
-# CONFIG_I2C_RK3X is not set
-# CONFIG_I2C_SIMTEC is not set
-# CONFIG_I2C_XILINX is not set
-
-#
-# External I2C/SMBus adapter drivers
-#
-# CONFIG_I2C_DIOLAN_U2C is not set
-# CONFIG_I2C_PARPORT_LIGHT is not set
-# CONFIG_I2C_ROBOTFUZZ_OSIF is not set
-# CONFIG_I2C_TAOS_EVM is not set
-# CONFIG_I2C_TINY_USB is not set
-
-#
-# Other I2C/SMBus bus drivers
-#
-# CONFIG_I2C_STUB is not set
-# CONFIG_I2C_SLAVE is not set
-# CONFIG_I2C_DEBUG_CORE is not set
-# CONFIG_I2C_DEBUG_ALGO is not set
-# CONFIG_I2C_DEBUG_BUS is not set
-CONFIG_SPI=y
-# CONFIG_SPI_DEBUG is not set
-CONFIG_SPI_MASTER=y
-
-#
-# SPI Master Controller Drivers
-#
-# CONFIG_SPI_ALTERA is not set
-# CONFIG_SPI_AXI_SPI_ENGINE is not set
-# CONFIG_SPI_BITBANG is not set
-# CONFIG_SPI_CADENCE is not set
-# CONFIG_SPI_DESIGNWARE is not set
-# CONFIG_SPI_GPIO is not set
-# CONFIG_SPI_FSL_SPI is not set
-# CONFIG_SPI_OC_TINY is not set
-# CONFIG_SPI_PXA2XX_PCI is not set
-# CONFIG_SPI_ROCKCHIP is not set
-# CONFIG_SPI_SC18IS602 is not set
-# CONFIG_SPI_XCOMM is not set
-# CONFIG_SPI_XILINX is not set
-# CONFIG_SPI_ZYNQMP_GQSPI is not set
-
-#
-# SPI Protocol Masters
-#
-# CONFIG_SPI_SPIDEV is not set
-# CONFIG_SPI_LOOPBACK_TEST is not set
-# CONFIG_SPI_TLE62X0 is not set
-# CONFIG_SPMI is not set
-# CONFIG_HSI is not set
-
-#
-# PPS support
-#
-# CONFIG_PPS is not set
-
-#
-# PPS generators support
-#
-
-#
-# PTP clock support
-#
-# CONFIG_PTP_1588_CLOCK is not set
-
-#
-# Enable PHYLIB and NETWORK_PHY_TIMESTAMPING to see the additional clocks.
-#
-CONFIG_ARCH_HAVE_CUSTOM_GPIO_H=y
-CONFIG_GPIOLIB=y
-CONFIG_OF_GPIO=y
-# CONFIG_DEBUG_GPIO is not set
-CONFIG_GPIO_SYSFS=y
-
-#
-# Memory mapped GPIO drivers
-#
-# CONFIG_GPIO_74XX_MMIO is not set
-# CONFIG_GPIO_ALTERA is not set
-# CONFIG_GPIO_DWAPB is not set
-# CONFIG_GPIO_EM is not set
-# CONFIG_GPIO_GENERIC_PLATFORM is not set
-# CONFIG_GPIO_GRGPIO is not set
-# CONFIG_GPIO_MOCKUP is not set
-# CONFIG_GPIO_MPC8XXX is not set
-# CONFIG_GPIO_XILINX is not set
-# CONFIG_GPIO_ZEVIO is not set
-# CONFIG_GPIO_ZX is not set
-
-#
-# I2C GPIO expanders
-#
-# CONFIG_GPIO_ADP5588 is not set
-# CONFIG_GPIO_ADNP is not set
-# CONFIG_GPIO_MAX7300 is not set
-# CONFIG_GPIO_MAX732X is not set
-# CONFIG_GPIO_PCA953X is not set
-# CONFIG_GPIO_PCF857X is not set
-# CONFIG_GPIO_SX150X is not set
-# CONFIG_GPIO_TPIC2810 is not set
-# CONFIG_GPIO_TS4900 is not set
-
-#
-# MFD GPIO expanders
-#
-# CONFIG_HTC_EGPIO is not set
-
-#
-# SPI GPIO expanders
-#
-# CONFIG_GPIO_74X164 is not set
-# CONFIG_GPIO_MAX7301 is not set
-# CONFIG_GPIO_MC33880 is not set
-# CONFIG_GPIO_PISOSR is not set
-
-#
-# SPI or I2C GPIO expanders
-#
-# CONFIG_GPIO_MCP23S08 is not set
-
-#
-# USB GPIO expanders
-#
-# CONFIG_W1 is not set
-# CONFIG_POWER_AVS is not set
-# CONFIG_POWER_RESET is not set
-# CONFIG_POWER_SUPPLY is not set
-# CONFIG_HWMON is not set
-# CONFIG_THERMAL is not set
-CONFIG_WATCHDOG=y
-CONFIG_WATCHDOG_CORE=y
-CONFIG_WATCHDOG_NOWAYOUT=y
-# CONFIG_WATCHDOG_SYSFS is not set
-
-#
-# Watchdog Device Drivers
-#
-# CONFIG_SOFT_WATCHDOG is not set
-# CONFIG_GPIO_WATCHDOG is not set
-# CONFIG_XILINX_WATCHDOG is not set
-# CONFIG_ZIIRAVE_WATCHDOG is not set
-# CONFIG_CADENCE_WATCHDOG is not set
-# CONFIG_DW_WATCHDOG is not set
-# CONFIG_MAX63XX_WATCHDOG is not set
-# CONFIG_MEN_A21_WDT is not set
-
-#
-# USB-based Watchdog Cards
-#
-# CONFIG_USBPCWATCHDOG is not set
-
-#
-# Watchdog Pretimeout Governors
-#
-# CONFIG_WATCHDOG_PRETIMEOUT_GOV is not set
-CONFIG_SSB_POSSIBLE=y
-
-#
-# Sonics Silicon Backplane
-#
-# CONFIG_SSB is not set
-CONFIG_BCMA_POSSIBLE=y
-
-#
-# Broadcom specific AMBA
-#
-# CONFIG_BCMA is not set
-
-#
-# Multifunction device drivers
-#
-# CONFIG_MFD_CORE is not set
-# CONFIG_MFD_ACT8945A is not set
-# CONFIG_MFD_AS3711 is not set
-# CONFIG_MFD_AS3722 is not set
-# CONFIG_PMIC_ADP5520 is not set
-# CONFIG_MFD_AAT2870_CORE is not set
-# CONFIG_MFD_ATMEL_FLEXCOM is not set
-# CONFIG_MFD_ATMEL_HLCDC is not set
-# CONFIG_MFD_BCM590XX is not set
-# CONFIG_MFD_AXP20X_I2C is not set
-# CONFIG_MFD_CROS_EC is not set
-# CONFIG_MFD_ASIC3 is not set
-# CONFIG_PMIC_DA903X is not set
-# CONFIG_MFD_DA9052_SPI is not set
-# CONFIG_MFD_DA9052_I2C is not set
-# CONFIG_MFD_DA9055 is not set
-# CONFIG_MFD_DA9062 is not set
-# CONFIG_MFD_DA9063 is not set
-# CONFIG_MFD_DA9150 is not set
-# CONFIG_MFD_DLN2 is not set
-# CONFIG_MFD_EXYNOS_LPASS is not set
-# CONFIG_MFD_MC13XXX_SPI is not set
-# CONFIG_MFD_MC13XXX_I2C is not set
-# CONFIG_MFD_HI6421_PMIC is not set
-# CONFIG_HTC_PASIC3 is not set
-# CONFIG_HTC_I2CPLD is not set
-# CONFIG_INTEL_SOC_PMIC is not set
-# CONFIG_MFD_KEMPLD is not set
-# CONFIG_MFD_88PM800 is not set
-# CONFIG_MFD_88PM805 is not set
-# CONFIG_MFD_88PM860X is not set
-# CONFIG_MFD_MAX14577 is not set
-# CONFIG_MFD_MAX77620 is not set
-# CONFIG_MFD_MAX77686 is not set
-# CONFIG_MFD_MAX77693 is not set
-# CONFIG_MFD_MAX77843 is not set
-# CONFIG_MFD_MAX8907 is not set
-# CONFIG_MFD_MAX8925 is not set
-# CONFIG_MFD_MAX8997 is not set
-# CONFIG_MFD_MAX8998 is not set
-# CONFIG_MFD_MT6397 is not set
-# CONFIG_MFD_MENF21BMC is not set
-# CONFIG_EZX_PCAP is not set
-# CONFIG_MFD_VIPERBOARD is not set
-# CONFIG_MFD_RETU is not set
-# CONFIG_MFD_PCF50633 is not set
-# CONFIG_MFD_PM8921_CORE is not set
-# CONFIG_MFD_RT5033 is not set
-# CONFIG_MFD_RTSX_USB is not set
-# CONFIG_MFD_RC5T583 is not set
-# CONFIG_MFD_RK808 is not set
-# CONFIG_MFD_RN5T618 is not set
-# CONFIG_MFD_SEC_CORE is not set
-# CONFIG_MFD_SI476X_CORE is not set
-# CONFIG_MFD_SM501 is not set
-# CONFIG_MFD_SKY81452 is not set
-# CONFIG_MFD_SMSC is not set
-# CONFIG_ABX500_CORE is not set
-# CONFIG_MFD_STMPE is not set
-# CONFIG_MFD_SYSCON is not set
-# CONFIG_MFD_TI_AM335X_TSCADC is not set
-# CONFIG_MFD_LP3943 is not set
-# CONFIG_MFD_LP8788 is not set
-# CONFIG_MFD_PALMAS is not set
-# CONFIG_TPS6105X is not set
-# CONFIG_TPS65010 is not set
-# CONFIG_TPS6507X is not set
-# CONFIG_MFD_TPS65086 is not set
-# CONFIG_MFD_TPS65090 is not set
-# CONFIG_MFD_TPS65217 is not set
-# CONFIG_MFD_TI_LP873X is not set
-# CONFIG_MFD_TPS65218 is not set
-# CONFIG_MFD_TPS6586X is not set
-# CONFIG_MFD_TPS65910 is not set
-# CONFIG_MFD_TPS65912_I2C is not set
-# CONFIG_MFD_TPS65912_SPI is not set
-# CONFIG_MFD_TPS80031 is not set
-# CONFIG_TWL4030_CORE is not set
-# CONFIG_TWL6040_CORE is not set
-# CONFIG_MFD_WL1273_CORE is not set
-# CONFIG_MFD_LM3533 is not set
-# CONFIG_MFD_TC3589X is not set
-# CONFIG_MFD_TMIO is not set
-# CONFIG_MFD_T7L66XB is not set
-# CONFIG_MFD_TC6387XB is not set
-# CONFIG_MFD_TC6393XB is not set
-# CONFIG_MFD_ARIZONA_I2C is not set
-# CONFIG_MFD_ARIZONA_SPI is not set
-# CONFIG_MFD_WM8400 is not set
-# CONFIG_MFD_WM831X_I2C is not set
-# CONFIG_MFD_WM831X_SPI is not set
-# CONFIG_MFD_WM8350_I2C is not set
-# CONFIG_MFD_WM8994 is not set
-# CONFIG_REGULATOR is not set
-# CONFIG_MEDIA_SUPPORT is not set
-
-#
-# Graphics support
-#
-# CONFIG_DRM is not set
-
-#
-# ACP (Audio CoProcessor) Configuration
-#
-
-#
-# Frame buffer Devices
-#
-CONFIG_FB=y
-# CONFIG_FIRMWARE_EDID is not set
-CONFIG_FB_CMDLINE=y
-CONFIG_FB_NOTIFY=y
-# CONFIG_FB_DDC is not set
-# CONFIG_FB_BOOT_VESA_SUPPORT is not set
-# CONFIG_FB_CFB_FILLRECT is not set
-# CONFIG_FB_CFB_COPYAREA is not set
-# CONFIG_FB_CFB_IMAGEBLIT is not set
-# CONFIG_FB_CFB_REV_PIXELS_IN_BYTE is not set
-# CONFIG_FB_SYS_FILLRECT is not set
-# CONFIG_FB_SYS_COPYAREA is not set
-# CONFIG_FB_SYS_IMAGEBLIT is not set
-# CONFIG_FB_FOREIGN_ENDIAN is not set
-# CONFIG_FB_SYS_FOPS is not set
-# CONFIG_FB_SVGALIB is not set
-# CONFIG_FB_MACMODES is not set
-# CONFIG_FB_BACKLIGHT is not set
-# CONFIG_FB_MODE_HELPERS is not set
-# CONFIG_FB_TILEBLITTING is not set
-
-#
-# Frame buffer hardware drivers
-#
-# CONFIG_FB_OPENCORES is not set
-# CONFIG_FB_S1D13XXX is not set
-# CONFIG_FB_SMSCUFX is not set
-# CONFIG_FB_UDL is not set
-# CONFIG_FB_IBM_GXT4500 is not set
-# CONFIG_FB_VIRTUAL is not set
-# CONFIG_FB_METRONOME is not set
-# CONFIG_FB_BROADSHEET is not set
-# CONFIG_FB_AUO_K190X is not set
-# CONFIG_FB_SIMPLE is not set
-# CONFIG_FB_SSD1307 is not set
-# CONFIG_BACKLIGHT_LCD_SUPPORT is not set
-# CONFIG_VGASTATE is not set
-# CONFIG_LOGO is not set
-# CONFIG_SOUND is not set
-CONFIG_USB_OHCI_LITTLE_ENDIAN=y
-CONFIG_USB_SUPPORT=y
-CONFIG_MP_USB_MSTAR=y
-CONFIG_USB_COMMON=y
-CONFIG_USB_ARCH_HAS_HCD=y
-CONFIG_USB=y
-CONFIG_USB_ANNOUNCE_NEW_DEVICES=y
-
-#
-# Miscellaneous USB options
-#
-CONFIG_USB_DEFAULT_PERSIST=y
-# CONFIG_USB_DYNAMIC_MINORS is not set
-# CONFIG_USB_OTG_WHITELIST is not set
-# CONFIG_USB_OTG_BLACKLIST_HUB is not set
-# CONFIG_USB_MON is not set
-# CONFIG_USB_WUSB_CBAF is not set
-
-#
-# USB Host Controller Drivers
-#
-# CONFIG_USB_C67X00_HCD is not set
-# CONFIG_USB_XHCI_HCD is not set
-CONFIG_USB_EHCI_HCD=y
-CONFIG_USB_EHCI_ROOT_HUB_TT=y
-CONFIG_USB_EHCI_TT_NEWSCHED=y
-# CONFIG_USB_EHCI_SUSPEND_PORT is not set
-# CONFIG_USB_EHCI_HCD_PLATFORM is not set
-# CONFIG_USB_OXU210HP_HCD is not set
-# CONFIG_USB_ISP116X_HCD is not set
-# CONFIG_USB_ISP1362_HCD is not set
-# CONFIG_USB_FOTG210_HCD is not set
-# CONFIG_USB_MAX3421_HCD is not set
-# CONFIG_USB_OHCI_HCD is not set
-# CONFIG_USB_SL811_HCD is not set
-# CONFIG_USB_R8A66597_HCD is not set
-# CONFIG_USB_HCD_TEST_MODE is not set
-
-#
-# USB Device Class drivers
-#
-# CONFIG_USB_ACM is not set
-# CONFIG_USB_PRINTER is not set
-# CONFIG_USB_WDM is not set
-# CONFIG_USB_TMC is not set
-
-#
-# NOTE: USB_STORAGE depends on SCSI but BLK_DEV_SD may
-#
-
-#
-# also be needed; see USB_STORAGE Help for more info
-#
-# CONFIG_USB_STORAGE is not set
-
-#
-# USB Imaging devices
-#
-# CONFIG_USB_MDC800 is not set
-# CONFIG_USB_MICROTEK is not set
-# CONFIG_USBIP_CORE is not set
-# CONFIG_USB_MUSB_HDRC is not set
-# CONFIG_USB_DWC3 is not set
-# CONFIG_USB_DWC2 is not set
-# CONFIG_USB_CHIPIDEA is not set
-# CONFIG_USB_ISP1760 is not set
-
-#
-# USB port drivers
-#
-# CONFIG_USB_SERIAL is not set
-
-#
-# USB Miscellaneous drivers
-#
-# CONFIG_USB_EMI62 is not set
-# CONFIG_USB_EMI26 is not set
-# CONFIG_USB_ADUTUX is not set
-# CONFIG_USB_SEVSEG is not set
-# CONFIG_USB_RIO500 is not set
-# CONFIG_USB_LEGOTOWER is not set
-# CONFIG_USB_LCD is not set
-# CONFIG_USB_CYPRESS_CY7C63 is not set
-# CONFIG_USB_CYTHERM is not set
-# CONFIG_USB_IDMOUSE is not set
-# CONFIG_USB_FTDI_ELAN is not set
-# CONFIG_USB_APPLEDISPLAY is not set
-# CONFIG_USB_SISUSBVGA is not set
-# CONFIG_USB_LD is not set
-# CONFIG_USB_TRANCEVIBRATOR is not set
-# CONFIG_USB_IOWARRIOR is not set
-# CONFIG_USB_TEST is not set
-# CONFIG_USB_EHSET_TEST_FIXTURE is not set
-# CONFIG_USB_ISIGHTFW is not set
-# CONFIG_USB_YUREX is not set
-# CONFIG_USB_EZUSB_FX2 is not set
-# CONFIG_USB_HSIC_USB3503 is not set
-# CONFIG_USB_HSIC_USB4604 is not set
-# CONFIG_USB_LINK_LAYER_TEST is not set
-
-#
-# USB Physical Layer drivers
-#
-# CONFIG_USB_PHY is not set
-# CONFIG_NOP_USB_XCEIV is not set
-# CONFIG_USB_GPIO_VBUS is not set
-# CONFIG_USB_ISP1301 is not set
-# CONFIG_USB_ULPI is not set
-# CONFIG_USB_GADGET is not set
-# CONFIG_USB_ULPI_BUS is not set
-# CONFIG_UWB is not set
-CONFIG_MMC=y
-CONFIG_SS_FAST_MMC=y
-# CONFIG_MMC_DEBUG is not set
-CONFIG_PWRSEQ_EMMC=y
-CONFIG_PWRSEQ_SIMPLE=y
-
-#
-# MMC/SD/SDIO Card Drivers
-#
-CONFIG_MMC_BLOCK=y
-CONFIG_MMC_BLOCK_MINORS=8
-CONFIG_MMC_BLOCK_BOUNCE=y
-# CONFIG_SDIO_UART is not set
-# CONFIG_MMC_TEST is not set
-
-#
-# MMC/SD/SDIO Host Controller Drivers
-#
-# CONFIG_MMC_SDHCI is not set
-# CONFIG_MMC_SPI is not set
-# CONFIG_MMC_DW is not set
-# CONFIG_MMC_VUB300 is not set
-# CONFIG_MMC_USHC is not set
-# CONFIG_MMC_USDHI6ROL0 is not set
-# CONFIG_MMC_MTK is not set
-# CONFIG_MEMSTICK is not set
-# CONFIG_NEW_LEDS is not set
-# CONFIG_ACCESSIBILITY is not set
-CONFIG_EDAC_ATOMIC_SCRUB=y
-CONFIG_EDAC_SUPPORT=y
-# CONFIG_EDAC is not set
-CONFIG_RTC_LIB=y
-CONFIG_RTC_CLASS=y
-CONFIG_RTC_HCTOSYS=y
-CONFIG_RTC_HCTOSYS_DEVICE="rtc0"
-CONFIG_RTC_SYSTOHC=y
-CONFIG_RTC_SYSTOHC_DEVICE="rtc0"
-# CONFIG_RTC_DEBUG is not set
-
-#
-# RTC interfaces
-#
-CONFIG_RTC_INTF_SYSFS=y
-CONFIG_RTC_INTF_PROC=y
-CONFIG_RTC_INTF_DEV=y
-# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set
-# CONFIG_RTC_DRV_TEST is not set
-
-#
-# I2C RTC drivers
-#
-# CONFIG_RTC_DRV_ABB5ZES3 is not set
-# CONFIG_RTC_DRV_ABX80X is not set
-# CONFIG_RTC_DRV_DS1307 is not set
-# CONFIG_RTC_DRV_DS1374 is not set
-# CONFIG_RTC_DRV_DS1672 is not set
-# CONFIG_RTC_DRV_HYM8563 is not set
-# CONFIG_RTC_DRV_MAX6900 is not set
-# CONFIG_RTC_DRV_RS5C372 is not set
-# CONFIG_RTC_DRV_ISL1208 is not set
-# CONFIG_RTC_DRV_ISL12022 is not set
-# CONFIG_RTC_DRV_X1205 is not set
-# CONFIG_RTC_DRV_PCF8523 is not set
-# CONFIG_RTC_DRV_PCF85063 is not set
-# CONFIG_RTC_DRV_PCF8563 is not set
-# CONFIG_RTC_DRV_PCF8583 is not set
-# CONFIG_RTC_DRV_M41T80 is not set
-# CONFIG_RTC_DRV_BQ32K is not set
-# CONFIG_RTC_DRV_S35390A is not set
-# CONFIG_RTC_DRV_FM3130 is not set
-# CONFIG_RTC_DRV_RX8010 is not set
-# CONFIG_RTC_DRV_RX8581 is not set
-# CONFIG_RTC_DRV_RX8025 is not set
-# CONFIG_RTC_DRV_EM3027 is not set
-# CONFIG_RTC_DRV_RV8803 is not set
-
-#
-# SPI RTC drivers
-#
-# CONFIG_RTC_DRV_M41T93 is not set
-# CONFIG_RTC_DRV_M41T94 is not set
-# CONFIG_RTC_DRV_DS1302 is not set
-# CONFIG_RTC_DRV_DS1305 is not set
-# CONFIG_RTC_DRV_DS1343 is not set
-# CONFIG_RTC_DRV_DS1347 is not set
-# CONFIG_RTC_DRV_DS1390 is not set
-# CONFIG_RTC_DRV_MAX6916 is not set
-# CONFIG_RTC_DRV_R9701 is not set
-# CONFIG_RTC_DRV_RX4581 is not set
-# CONFIG_RTC_DRV_RX6110 is not set
-# CONFIG_RTC_DRV_RS5C348 is not set
-# CONFIG_RTC_DRV_MAX6902 is not set
-# CONFIG_RTC_DRV_PCF2123 is not set
-# CONFIG_RTC_DRV_MCP795 is not set
-CONFIG_RTC_I2C_AND_SPI=y
-
-#
-# SPI and I2C RTC drivers
-#
-# CONFIG_RTC_DRV_DS3232 is not set
-# CONFIG_RTC_DRV_PCF2127 is not set
-# CONFIG_RTC_DRV_RV3029C2 is not set
-
-#
-# Platform RTC drivers
-#
-# CONFIG_RTC_DRV_CMOS is not set
-# CONFIG_RTC_DRV_DS1286 is not set
-# CONFIG_RTC_DRV_DS1511 is not set
-# CONFIG_RTC_DRV_DS1553 is not set
-# CONFIG_RTC_DRV_DS1685_FAMILY is not set
-# CONFIG_RTC_DRV_DS1742 is not set
-# CONFIG_RTC_DRV_DS2404 is not set
-# CONFIG_RTC_DRV_STK17TA8 is not set
-# CONFIG_RTC_DRV_M48T86 is not set
-# CONFIG_RTC_DRV_M48T35 is not set
-# CONFIG_RTC_DRV_M48T59 is not set
-# CONFIG_RTC_DRV_MSM6242 is not set
-# CONFIG_RTC_DRV_BQ4802 is not set
-# CONFIG_RTC_DRV_RP5C01 is not set
-# CONFIG_RTC_DRV_V3020 is not set
-# CONFIG_RTC_DRV_ZYNQMP is not set
-
-#
-# on-CPU RTC drivers
-#
-# CONFIG_RTC_DRV_SNVS is not set
-
-#
-# HID Sensor RTC drivers
-#
-# CONFIG_DMADEVICES is not set
-
-#
-# DMABUF options
-#
-# CONFIG_SYNC_FILE is not set
-# CONFIG_AUXDISPLAY is not set
-CONFIG_UIO=y
-CONFIG_UIO_PDRV_GENIRQ=y
-# CONFIG_UIO_DMEM_GENIRQ is not set
-# CONFIG_UIO_PRUSS is not set
-# CONFIG_VIRT_DRIVERS is not set
-
-#
-# Virtio drivers
-#
-# CONFIG_VIRTIO_MMIO is not set
-
-#
-# Microsoft Hyper-V guest support
-#
-CONFIG_STAGING=y
-# CONFIG_PRISM2_USB is not set
-# CONFIG_COMEDI is not set
-# CONFIG_RTLLIB is not set
-# CONFIG_R8712U is not set
-# CONFIG_R8188EU is not set
-
-#
-# Speakup console speech
-#
-# CONFIG_STAGING_MEDIA is not set
-
-#
-# Android
-#
-# CONFIG_ASHMEM is not set
-# CONFIG_ANDROID_LOW_MEMORY_KILLER is not set
-# CONFIG_ION is not set
-# CONFIG_STAGING_BOARD is not set
-# CONFIG_LTE_GDM724X is not set
-# CONFIG_MTD_SPINAND_MT29F is not set
-# CONFIG_LNET is not set
-# CONFIG_GS_FPGABOOT is not set
-# CONFIG_COMMON_CLK_XLNX_CLKWZRD is not set
-# CONFIG_FB_TFT is not set
-# CONFIG_WILC1000_SDIO is not set
-# CONFIG_WILC1000_SPI is not set
-# CONFIG_MOST is not set
-# CONFIG_KS7010 is not set
-# CONFIG_GREYBUS is not set
-# CONFIG_GOLDFISH is not set
-# CONFIG_CHROME_PLATFORMS is not set
-CONFIG_CLKDEV_LOOKUP=y
-CONFIG_HAVE_CLK_PREPARE=y
-CONFIG_COMMON_CLK=y
-
-#
-# Common Clock Framework
-#
-# CONFIG_COMMON_CLK_SI5351 is not set
-# CONFIG_COMMON_CLK_SI514 is not set
-# CONFIG_COMMON_CLK_SI570 is not set
-# CONFIG_COMMON_CLK_CDCE706 is not set
-# CONFIG_COMMON_CLK_CDCE925 is not set
-# CONFIG_COMMON_CLK_CS2000_CP is not set
-# CONFIG_CLK_QORIQ is not set
-# CONFIG_COMMON_CLK_NXP is not set
-# CONFIG_COMMON_CLK_PWM is not set
-# CONFIG_COMMON_CLK_PXA is not set
-# CONFIG_COMMON_CLK_PIC32 is not set
-
-#
-# Hardware Spinlock drivers
-#
-
-#
-# Clock Source drivers
-#
-CONFIG_CLKSRC_OF=y
-CONFIG_CLKSRC_PROBE=y
-CONFIG_ARM_ARCH_TIMER=y
-CONFIG_ARM_ARCH_TIMER_EVTSTREAM=y
-# CONFIG_ARM_TIMER_SP804 is not set
-# CONFIG_ATMEL_PIT is not set
-# CONFIG_SH_TIMER_CMT is not set
-# CONFIG_SH_TIMER_MTU2 is not set
-# CONFIG_SH_TIMER_TMU is not set
-# CONFIG_EM_TIMER_STI is not set
-# CONFIG_MAILBOX is not set
-# CONFIG_IOMMU_SUPPORT is not set
-
-#
-# Remoteproc drivers
-#
-# CONFIG_STE_MODEM_RPROC is not set
-
-#
-# Rpmsg drivers
-#
-
-#
-# SOC (System On Chip) specific Drivers
-#
-
-#
-# Broadcom SoC drivers
-#
-# CONFIG_SOC_BRCMSTB is not set
-# CONFIG_SUNXI_SRAM is not set
-# CONFIG_SOC_TI is not set
-# CONFIG_PM_DEVFREQ is not set
-# CONFIG_EXTCON is not set
-# CONFIG_MEMORY is not set
-# CONFIG_IIO is not set
-CONFIG_PWM=y
-CONFIG_PWM_SYSFS=y
-# CONFIG_PWM_FSL_FTM is not set
-# CONFIG_PWM_PCA9685 is not set
-CONFIG_IRQCHIP=y
-CONFIG_ARM_GIC=y
-CONFIG_ARM_GIC_MAX_NR=1
-# CONFIG_IPACK_BUS is not set
-# CONFIG_RESET_CONTROLLER is not set
-# CONFIG_FMC is not set
-
-#
-# PHY Subsystem
-#
-# CONFIG_GENERIC_PHY is not set
-# CONFIG_PHY_PXA_28NM_HSIC is not set
-# CONFIG_PHY_PXA_28NM_USB2 is not set
-# CONFIG_BCM_KONA_USB2_PHY is not set
-# CONFIG_POWERCAP is not set
-# CONFIG_MCB is not set
-
-#
-# Performance monitor support
-#
-CONFIG_ARM_PMU=y
-# CONFIG_RAS is not set
-
-#
-# Android
-#
-CONFIG_ANDROID=y
-# CONFIG_ANDROID_BINDER_IPC is not set
-CONFIG_NVMEM=y
-# CONFIG_STM is not set
-# CONFIG_INTEL_TH is not set
-
-#
-# FPGA Configuration Support
-#
-# CONFIG_FPGA is not set
-CONFIG_MSTAR_DRIVERS=y
-# CONFIG_CAM_DRIVERS is not set
-# CONFIG_DLA_DRIVER is not set
-# CONFIG_MS_PIU_TIMER is not set
-CONFIG_MS_MSYS=y
-CONFIG_MS_ZEN=y
-# CONFIG_MS_MSYS_LOG is not set
-# CONFIG_MSYS_PERF_TEST is not set
-# CONFIG_MSYS_BENCH_MEMORY_FUNC is not set
-# CONFIG_MSYS_MIU_PROTECT is not set
-# CONFIG_MSYS_DMEM_SYSFS_ALL is not set
-CONFIG_MS_SERIAL=y
-# CONFIG_MS_USCLK is not set
-CONFIG_MS_FLASH_ISP=y
-CONFIG_MS_FLASH_ISP_MXP_PARTS=y
-CONFIG_MS_PWM=y
-CONFIG_MS_SPINAND=y
-# CONFIG_NAND_SINGLE_READ is not set
-# CONFIG_NAND_DUAL_READ is not set
-# CONFIG_NAND_QUAL_READ is not set
-CONFIG_AUTO_DETECT=y
-# CONFIG_NAND_QUAL_WRITE is not set
-CONFIG_AUTO_DETECT_WRITE=y
-CONFIG_MS_SPI_INFINITY=y
-# CONFIG_CAM_CLK is not set
-# CONFIG_MS_EMMC is not set
-CONFIG_MS_SDMMC=y
-CONFIG_MS_EMAC=y
-# CONFIG_EMAC_SUPPLY_RNG is not set
-# CONFIG_MSTAR_HW_TX_CHECKSUM is not set
-# CONFIG_K3_RX_SWPATCH is not set
-CONFIG_DISCONNECT_DELAY_S=1
-# CONFIG_MSTAR_EEE is not set
-# CONFIG_EMAC_PHY_RESTART_AN is not set
-# CONFIG_MS_IRCUT is not set
-CONFIG_MS_RTC=y
-# CONFIG_RTC_INNER is not set
-CONFIG_RTCPWC_INNER=y
-# CONFIG_RTCPWC_SW_RST_OFF is not set
-# CONFIG_RTCPWC_INNER_EHHE is not set
-CONFIG_MS_CRYPTO=y
-# CONFIG_SS_AESDMA_INTR is not set
-# CONFIG_SS_RNG is not set
-CONFIG_CRYPTODEV=y
-CONFIG_MS_CPU_FREQ=y
-CONFIG_MS_IVE=y
-CONFIG_MS_NOTIFY=m
-CONFIG_SS_ISP_ISRCB=y
-CONFIG_MSTAR_MIU=y
-CONFIG_SSC007A_S01A=y
-CONFIG_MS_BDMA=y
-# CONFIG_MS_BDMA_LINE_OFFSET_ON is not set
-CONFIG_MS_MOVE_DMA=y
-# CONFIG_MS_IR is not set
-CONFIG_MS_I2C=y
-# CONFIG_MS_I2C_INT_ISR is not set
-CONFIG_MS_GPIO=y
-CONFIG_MS_SW_I2C=y
-CONFIG_MS_PADMUX=y
-CONFIG_MS_WATCHDOG=y
-CONFIG_MS_SAR=y
-# CONFIG_MS_SARKEY is not set
-CONFIG_MSTAR_MMAHEAP=y
-CONFIG_SSTAR_NETPHY=y
-CONFIG_SS_VOLTAGE_CTRL=y
-# CONFIG_SS_SWTOE is not set
-# CONFIG_MS_EMAC_TOE is not set
-
-#
-# Firmware Drivers
-#
-# CONFIG_FIRMWARE_MEMMAP is not set
-# CONFIG_FW_CFG_SYSFS is not set
-CONFIG_HAVE_ARM_SMCCC=y
-
-#
-# File systems
-#
-CONFIG_DCACHE_WORD_ACCESS=y
-# CONFIG_EXT2_FS is not set
-# CONFIG_EXT3_FS is not set
-# CONFIG_EXT4_FS is not set
-# CONFIG_REISERFS_FS is not set
-# CONFIG_JFS_FS is not set
-# CONFIG_OCFS2_FS is not set
-# CONFIG_BTRFS_FS is not set
-# CONFIG_NILFS2_FS is not set
-# CONFIG_F2FS_FS is not set
-CONFIG_FS_POSIX_ACL=y
-# CONFIG_EXPORTFS_BLOCK_OPS is not set
-CONFIG_FILE_LOCKING=y
-CONFIG_MANDATORY_FILE_LOCKING=y
-# CONFIG_FS_ENCRYPTION is not set
-CONFIG_FSNOTIFY=y
-CONFIG_DNOTIFY=y
-CONFIG_INOTIFY_USER=y
-# CONFIG_FANOTIFY is not set
-# CONFIG_QUOTA is not set
-# CONFIG_QUOTACTL is not set
-# CONFIG_AUTOFS4_FS is not set
-# CONFIG_FUSE_FS is not set
-# CONFIG_OVERLAY_FS is not set
-
-#
-# Caches
-#
-# CONFIG_FSCACHE is not set
-
-#
-# CD-ROM/DVD Filesystems
-#
-# CONFIG_ISO9660_FS is not set
-# CONFIG_UDF_FS is not set
-
-#
-# DOS/FAT/NT Filesystems
-#
-CONFIG_FAT_FS=y
-CONFIG_MSDOS_FS=y
-CONFIG_VFAT_FS=y
-CONFIG_FAT_DEFAULT_CODEPAGE=437
-CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1"
-# CONFIG_FAT_DEFAULT_UTF8 is not set
-# CONFIG_NTFS_FS is not set
-
-#
-# Pseudo filesystems
-#
-CONFIG_PROC_FS=y
-CONFIG_PROC_SYSCTL=y
-CONFIG_PROC_PAGE_MONITOR=y
-# CONFIG_PROC_CHILDREN is not set
-CONFIG_KERNFS=y
-CONFIG_SYSFS=y
-CONFIG_TMPFS=y
-CONFIG_TMPFS_POSIX_ACL=y
-CONFIG_TMPFS_XATTR=y
-# CONFIG_HUGETLB_PAGE is not set
-CONFIG_CONFIGFS_FS=y
-CONFIG_MISC_FILESYSTEMS=y
-# CONFIG_ORANGEFS_FS is not set
-# CONFIG_ADFS_FS is not set
-# CONFIG_AFFS_FS is not set
-# CONFIG_ECRYPT_FS is not set
-# CONFIG_HFS_FS is not set
-# CONFIG_HFSPLUS_FS is not set
-# CONFIG_BEFS_FS is not set
-# CONFIG_BFS_FS is not set
-# CONFIG_EFS_FS is not set
-CONFIG_JFFS2_FS=y
-CONFIG_JFFS2_FS_DEBUG=0
-CONFIG_JFFS2_FS_WRITEBUFFER=y
-# CONFIG_JFFS2_FS_WBUF_VERIFY is not set
-# CONFIG_JFFS2_SUMMARY is not set
-# CONFIG_JFFS2_FS_XATTR is not set
-CONFIG_JFFS2_COMPRESSION_OPTIONS=y
-CONFIG_JFFS2_ZLIB=y
-CONFIG_JFFS2_LZO=y
-CONFIG_JFFS2_RTIME=y
-# CONFIG_JFFS2_RUBIN is not set
-# CONFIG_JFFS2_CMODE_NONE is not set
-CONFIG_JFFS2_CMODE_PRIORITY=y
-# CONFIG_JFFS2_CMODE_SIZE is not set
-# CONFIG_JFFS2_CMODE_FAVOURLZO is not set
-CONFIG_UBIFS_FS=y
-CONFIG_UBIFS_FS_ADVANCED_COMPR=y
-CONFIG_UBIFS_FS_LZO=y
-CONFIG_UBIFS_FS_ZLIB=y
-# CONFIG_UBIFS_ATIME_SUPPORT is not set
-# CONFIG_LOGFS is not set
-# CONFIG_CRAMFS is not set
-CONFIG_SQUASHFS=y
-# CONFIG_SQUASHFS_FILE_CACHE is not set
-CONFIG_SQUASHFS_FILE_DIRECT=y
-CONFIG_SQUASHFS_DECOMP_SINGLE=y
-# CONFIG_SQUASHFS_DECOMP_MULTI is not set
-# CONFIG_SQUASHFS_DECOMP_MULTI_PERCPU is not set
-# CONFIG_SQUASHFS_XATTR is not set
-CONFIG_SQUASHFS_ZLIB=y
-# CONFIG_SQUASHFS_LZ4 is not set
-CONFIG_SQUASHFS_LZO=y
-CONFIG_SQUASHFS_XZ=y
-CONFIG_SQUASHFS_4K_DEVBLK_SIZE=y
-CONFIG_SQUASHFS_EMBEDDED=y
-CONFIG_SQUASHFS_FRAGMENT_CACHE_SIZE=3
-# CONFIG_VXFS_FS is not set
-# CONFIG_MINIX_FS is not set
-# CONFIG_OMFS_FS is not set
-# CONFIG_HPFS_FS is not set
-# CONFIG_QNX4FS_FS is not set
-# CONFIG_QNX6FS_FS is not set
-# CONFIG_ROMFS_FS is not set
-# CONFIG_PSTORE is not set
-# CONFIG_SYSV_FS is not set
-# CONFIG_UFS_FS is not set
-CONFIG_NETWORK_FILESYSTEMS=y
-CONFIG_NFS_FS=y
-CONFIG_NFS_V2=y
-CONFIG_NFS_V3=y
-# CONFIG_NFS_V3_ACL is not set
-CONFIG_NFS_V4=y
-# CONFIG_NFS_SWAP is not set
-# CONFIG_NFS_V4_1 is not set
-# CONFIG_NFS_USE_LEGACY_DNS is not set
-CONFIG_NFS_USE_KERNEL_DNS=y
-# CONFIG_NFSD is not set
-CONFIG_GRACE_PERIOD=y
-CONFIG_LOCKD=y
-CONFIG_LOCKD_V4=y
-CONFIG_NFS_COMMON=y
-CONFIG_SUNRPC=y
-CONFIG_SUNRPC_GSS=y
-# CONFIG_SUNRPC_DEBUG is not set
-# CONFIG_CEPH_FS is not set
-# CONFIG_CIFS is not set
-# CONFIG_NCP_FS is not set
-# CONFIG_CODA_FS is not set
-# CONFIG_AFS_FS is not set
-CONFIG_NLS=y
-CONFIG_NLS_DEFAULT="iso8859-1"
-CONFIG_NLS_CODEPAGE_437=y
-# CONFIG_NLS_CODEPAGE_737 is not set
-# CONFIG_NLS_CODEPAGE_775 is not set
-# CONFIG_NLS_CODEPAGE_850 is not set
-# CONFIG_NLS_CODEPAGE_852 is not set
-# CONFIG_NLS_CODEPAGE_855 is not set
-# CONFIG_NLS_CODEPAGE_857 is not set
-# CONFIG_NLS_CODEPAGE_860 is not set
-# CONFIG_NLS_CODEPAGE_861 is not set
-# CONFIG_NLS_CODEPAGE_862 is not set
-# CONFIG_NLS_CODEPAGE_863 is not set
-# CONFIG_NLS_CODEPAGE_864 is not set
-# CONFIG_NLS_CODEPAGE_865 is not set
-# CONFIG_NLS_CODEPAGE_866 is not set
-# CONFIG_NLS_CODEPAGE_869 is not set
-# CONFIG_NLS_CODEPAGE_936 is not set
-# CONFIG_NLS_CODEPAGE_950 is not set
-# CONFIG_NLS_CODEPAGE_932 is not set
-# CONFIG_NLS_CODEPAGE_949 is not set
-# CONFIG_NLS_CODEPAGE_874 is not set
-# CONFIG_NLS_ISO8859_8 is not set
-# CONFIG_NLS_CODEPAGE_1250 is not set
-# CONFIG_NLS_CODEPAGE_1251 is not set
-# CONFIG_NLS_ASCII is not set
-CONFIG_NLS_ISO8859_1=y
-# CONFIG_NLS_ISO8859_2 is not set
-# CONFIG_NLS_ISO8859_3 is not set
-# CONFIG_NLS_ISO8859_4 is not set
-# CONFIG_NLS_ISO8859_5 is not set
-# CONFIG_NLS_ISO8859_6 is not set
-# CONFIG_NLS_ISO8859_7 is not set
-# CONFIG_NLS_ISO8859_9 is not set
-# CONFIG_NLS_ISO8859_13 is not set
-# CONFIG_NLS_ISO8859_14 is not set
-# CONFIG_NLS_ISO8859_15 is not set
-# CONFIG_NLS_KOI8_R is not set
-# CONFIG_NLS_KOI8_U is not set
-# CONFIG_NLS_MAC_ROMAN is not set
-# CONFIG_NLS_MAC_CELTIC is not set
-# CONFIG_NLS_MAC_CENTEURO is not set
-# CONFIG_NLS_MAC_CROATIAN is not set
-# CONFIG_NLS_MAC_CYRILLIC is not set
-# CONFIG_NLS_MAC_GAELIC is not set
-# CONFIG_NLS_MAC_GREEK is not set
-# CONFIG_NLS_MAC_ICELAND is not set
-# CONFIG_NLS_MAC_INUIT is not set
-# CONFIG_NLS_MAC_ROMANIAN is not set
-# CONFIG_NLS_MAC_TURKISH is not set
-CONFIG_NLS_UTF8=m
-# CONFIG_DLM is not set
-
-#
-# Kernel hacking
-#
-
-#
-# printk and dmesg options
-#
-# CONFIG_PRINTK_TIME is not set
-CONFIG_MESSAGE_LOGLEVEL_DEFAULT=3
-# CONFIG_BOOT_PRINTK_DELAY is not set
-# CONFIG_DYNAMIC_DEBUG is not set
-
-#
-# Compile-time checks and compiler options
-#
-CONFIG_DEBUG_INFO=y
-# CONFIG_DEBUG_INFO_REDUCED is not set
-# CONFIG_DEBUG_INFO_SPLIT is not set
-# CONFIG_DEBUG_INFO_DWARF4 is not set
-# CONFIG_GDB_SCRIPTS is not set
-CONFIG_ENABLE_WARN_DEPRECATED=y
-CONFIG_ENABLE_MUST_CHECK=y
-CONFIG_FRAME_WARN=4096
-# CONFIG_STRIP_ASM_SYMS is not set
-# CONFIG_READABLE_ASM is not set
-# CONFIG_UNUSED_SYMBOLS is not set
-# CONFIG_PAGE_OWNER is not set
-CONFIG_DEBUG_FS=y
-# CONFIG_HEADERS_CHECK is not set
-# CONFIG_DEBUG_SECTION_MISMATCH is not set
-CONFIG_SECTION_MISMATCH_WARN_ONLY=y
-# CONFIG_DEBUG_FORCE_WEAK_PER_CPU is not set
-CONFIG_MAGIC_SYSRQ=y
-CONFIG_DEBUG_KERNEL=y
-
-#
-# Memory Debugging
-#
-# CONFIG_PAGE_EXTENSION is not set
-# CONFIG_DEBUG_PAGEALLOC is not set
-# CONFIG_PAGE_POISONING is not set
-# CONFIG_DEBUG_OBJECTS is not set
-# CONFIG_SLUB_STATS is not set
-CONFIG_HAVE_DEBUG_KMEMLEAK=y
-# CONFIG_DEBUG_KMEMLEAK is not set
-# CONFIG_DEBUG_STACK_USAGE is not set
-# CONFIG_DEBUG_VM is not set
-# CONFIG_DEBUG_MEMORY_INIT is not set
-# CONFIG_DEBUG_SHIRQ is not set
-
-#
-# Debug Lockups and Hangs
-#
-CONFIG_LOCKUP_DETECTOR=y
-# CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC is not set
-CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC_VALUE=0
-# CONFIG_DETECT_HUNG_TASK is not set
-# CONFIG_WQ_WATCHDOG is not set
-# CONFIG_PANIC_ON_OOPS is not set
-CONFIG_PANIC_ON_OOPS_VALUE=0
-CONFIG_PANIC_TIMEOUT=0
-# CONFIG_SCHED_DEBUG is not set
-# CONFIG_SCHED_INFO is not set
-# CONFIG_SCHEDSTATS is not set
-# CONFIG_SCHED_STACK_END_CHECK is not set
-# CONFIG_DEBUG_TIMEKEEPING is not set
-# CONFIG_TIMER_STATS is not set
-# CONFIG_DEBUG_PREEMPT is not set
-
-#
-# Lock Debugging (spinlocks, mutexes, etc...)
-#
-CONFIG_DEBUG_RT_MUTEXES=y
-CONFIG_DEBUG_SPINLOCK=y
-CONFIG_DEBUG_MUTEXES=y
-# CONFIG_DEBUG_WW_MUTEX_SLOWPATH is not set
-# CONFIG_DEBUG_LOCK_ALLOC is not set
-# CONFIG_PROVE_LOCKING is not set
-# CONFIG_LOCK_STAT is not set
-# CONFIG_DEBUG_ATOMIC_SLEEP is not set
-# CONFIG_DEBUG_LOCKING_API_SELFTESTS is not set
-# CONFIG_LOCK_TORTURE_TEST is not set
-CONFIG_STACKTRACE=y
-# CONFIG_DEBUG_KOBJECT is not set
-# CONFIG_DEBUG_BUGVERBOSE is not set
-# CONFIG_DEBUG_LIST is not set
-# CONFIG_DEBUG_PI_LIST is not set
-# CONFIG_DEBUG_SG is not set
-# CONFIG_DEBUG_NOTIFIERS is not set
-# CONFIG_DEBUG_CREDENTIALS is not set
-
-#
-# RCU Debugging
-#
-# CONFIG_PROVE_RCU is not set
-# CONFIG_SPARSE_RCU_POINTER is not set
-# CONFIG_TORTURE_TEST is not set
-# CONFIG_RCU_PERF_TEST is not set
-# CONFIG_RCU_TORTURE_TEST is not set
-CONFIG_RCU_CPU_STALL_TIMEOUT=21
-# CONFIG_RCU_TRACE is not set
-# CONFIG_RCU_EQS_DEBUG is not set
-# CONFIG_DEBUG_WQ_FORCE_RR_CPU is not set
-# CONFIG_DEBUG_BLOCK_EXT_DEVT is not set
-# CONFIG_NOTIFIER_ERROR_INJECTION is not set
-# CONFIG_FAULT_INJECTION is not set
-# CONFIG_LATENCYTOP is not set
-CONFIG_HAVE_FUNCTION_TRACER=y
-CONFIG_HAVE_DYNAMIC_FTRACE=y
-CONFIG_HAVE_FTRACE_MCOUNT_RECORD=y
-CONFIG_HAVE_SYSCALL_TRACEPOINTS=y
-CONFIG_HAVE_C_RECORDMCOUNT=y
-CONFIG_TRACING_SUPPORT=y
-# CONFIG_FTRACE is not set
-
-#
-# Runtime Testing
-#
-# CONFIG_LKDTM is not set
-# CONFIG_TEST_LIST_SORT is not set
-# CONFIG_BACKTRACE_SELF_TEST is not set
-# CONFIG_RBTREE_TEST is not set
-# CONFIG_INTERVAL_TREE_TEST is not set
-# CONFIG_PERCPU_TEST is not set
-# CONFIG_ATOMIC64_SELFTEST is not set
-# CONFIG_TEST_HEXDUMP is not set
-# CONFIG_TEST_STRING_HELPERS is not set
-# CONFIG_TEST_KSTRTOX is not set
-# CONFIG_TEST_PRINTF is not set
-# CONFIG_TEST_BITMAP is not set
-# CONFIG_TEST_UUID is not set
-# CONFIG_TEST_RHASHTABLE is not set
-# CONFIG_TEST_HASH is not set
-# CONFIG_DMA_API_DEBUG is not set
-# CONFIG_TEST_LKM is not set
-# CONFIG_TEST_USER_COPY is not set
-# CONFIG_TEST_BPF is not set
-# CONFIG_TEST_UDELAY is not set
-# CONFIG_MEMTEST is not set
-# CONFIG_TEST_STATIC_KEYS is not set
-# CONFIG_SAMPLES is not set
-CONFIG_HAVE_ARCH_KGDB=y
-# CONFIG_KGDB is not set
-# CONFIG_ARCH_WANTS_UBSAN_NO_NULL is not set
-# CONFIG_UBSAN is not set
-CONFIG_ARCH_HAS_DEVMEM_IS_ALLOWED=y
-# CONFIG_STRICT_DEVMEM is not set
-# CONFIG_ARM_PTDUMP is not set
-CONFIG_ARM_UNWIND=y
-# CONFIG_DEBUG_USER is not set
-# CONFIG_DEBUG_LL is not set
-CONFIG_DEBUG_LL_INCLUDE="mach/debug-macro.S"
-# CONFIG_DEBUG_UART_8250 is not set
-CONFIG_UNCOMPRESS_INCLUDE="debug/uncompress.h"
-# CONFIG_PID_IN_CONTEXTIDR is not set
-# CONFIG_DEBUG_SET_MODULE_RONX is not set
-# CONFIG_CORESIGHT is not set
-
-#
-# Security options
-#
-CONFIG_KEYS=y
-# CONFIG_PERSISTENT_KEYRINGS is not set
-# CONFIG_BIG_KEYS is not set
-# CONFIG_ENCRYPTED_KEYS is not set
-# CONFIG_KEY_DH_OPERATIONS is not set
-# CONFIG_SECURITY_DMESG_RESTRICT is not set
-# CONFIG_SECURITY is not set
-# CONFIG_SECURITYFS is not set
-CONFIG_HAVE_HARDENED_USERCOPY_ALLOCATOR=y
-CONFIG_HAVE_ARCH_HARDENED_USERCOPY=y
-# CONFIG_HARDENED_USERCOPY is not set
-CONFIG_DEFAULT_SECURITY_DAC=y
-CONFIG_DEFAULT_SECURITY=""
-CONFIG_CRYPTO=y
-
-#
-# Crypto core or helper
-#
-CONFIG_CRYPTO_ALGAPI=y
-CONFIG_CRYPTO_ALGAPI2=y
-CONFIG_CRYPTO_AEAD=y
-CONFIG_CRYPTO_AEAD2=y
-CONFIG_CRYPTO_BLKCIPHER=y
-CONFIG_CRYPTO_BLKCIPHER2=y
-CONFIG_CRYPTO_HASH=y
-CONFIG_CRYPTO_HASH2=y
-CONFIG_CRYPTO_RNG=y
-CONFIG_CRYPTO_RNG2=y
-CONFIG_CRYPTO_RNG_DEFAULT=y
-CONFIG_CRYPTO_AKCIPHER2=y
-CONFIG_CRYPTO_KPP2=y
-# CONFIG_CRYPTO_RSA is not set
-# CONFIG_CRYPTO_DH is not set
-# CONFIG_CRYPTO_ECDH is not set
-CONFIG_CRYPTO_MANAGER=y
-CONFIG_CRYPTO_MANAGER2=y
-# CONFIG_CRYPTO_USER is not set
-CONFIG_CRYPTO_MANAGER_DISABLE_TESTS=y
-# CONFIG_CRYPTO_GF128MUL is not set
-CONFIG_CRYPTO_NULL=y
-CONFIG_CRYPTO_NULL2=y
-CONFIG_CRYPTO_WORKQUEUE=y
-# CONFIG_CRYPTO_CRYPTD is not set
-# CONFIG_CRYPTO_MCRYPTD is not set
-# CONFIG_CRYPTO_AUTHENC is not set
-# CONFIG_CRYPTO_TEST is not set
-
-#
-# Authenticated Encryption with Associated Data
-#
-# CONFIG_CRYPTO_CCM is not set
-# CONFIG_CRYPTO_GCM is not set
-# CONFIG_CRYPTO_CHACHA20POLY1305 is not set
-CONFIG_CRYPTO_SEQIV=y
-CONFIG_CRYPTO_ECHAINIV=m
-
-#
-# Block modes
-#
-CONFIG_CRYPTO_CBC=y
-CONFIG_CRYPTO_CTR=y
-# CONFIG_CRYPTO_CTS is not set
-CONFIG_CRYPTO_ECB=y
-# CONFIG_CRYPTO_LRW is not set
-# CONFIG_CRYPTO_PCBC is not set
-# CONFIG_CRYPTO_XTS is not set
-# CONFIG_CRYPTO_KEYWRAP is not set
-
-#
-# Hash modes
-#
-CONFIG_CRYPTO_CMAC=y
-CONFIG_CRYPTO_HMAC=y
-# CONFIG_CRYPTO_XCBC is not set
-# CONFIG_CRYPTO_VMAC is not set
-
-#
-# Digest
-#
-# CONFIG_CRYPTO_CRC32C is not set
-# CONFIG_CRYPTO_CRC32 is not set
-# CONFIG_CRYPTO_CRCT10DIF is not set
-# CONFIG_CRYPTO_GHASH is not set
-# CONFIG_CRYPTO_POLY1305 is not set
-CONFIG_CRYPTO_MD4=y
-CONFIG_CRYPTO_MD5=y
-# CONFIG_CRYPTO_MICHAEL_MIC is not set
-# CONFIG_CRYPTO_RMD128 is not set
-# CONFIG_CRYPTO_RMD160 is not set
-# CONFIG_CRYPTO_RMD256 is not set
-# CONFIG_CRYPTO_RMD320 is not set
-# CONFIG_CRYPTO_SHA1 is not set
-CONFIG_CRYPTO_SHA256=y
-# CONFIG_CRYPTO_SHA512 is not set
-# CONFIG_CRYPTO_SHA3 is not set
-# CONFIG_CRYPTO_TGR192 is not set
-# CONFIG_CRYPTO_WP512 is not set
-
-#
-# Ciphers
-#
-CONFIG_CRYPTO_AES=y
-# CONFIG_CRYPTO_ANUBIS is not set
-CONFIG_CRYPTO_ARC4=y
-# CONFIG_CRYPTO_BLOWFISH is not set
-# CONFIG_CRYPTO_CAMELLIA is not set
-# CONFIG_CRYPTO_CAST5 is not set
-# CONFIG_CRYPTO_CAST6 is not set
-CONFIG_CRYPTO_DES=y
-# CONFIG_CRYPTO_FCRYPT is not set
-# CONFIG_CRYPTO_KHAZAD is not set
-# CONFIG_CRYPTO_SALSA20 is not set
-# CONFIG_CRYPTO_CHACHA20 is not set
-# CONFIG_CRYPTO_SEED is not set
-# CONFIG_CRYPTO_SERPENT is not set
-# CONFIG_CRYPTO_TEA is not set
-# CONFIG_CRYPTO_TWOFISH is not set
-
-#
-# Compression
-#
-CONFIG_CRYPTO_DEFLATE=y
-CONFIG_CRYPTO_LZO=y
-# CONFIG_CRYPTO_842 is not set
-# CONFIG_CRYPTO_LZ4 is not set
-# CONFIG_CRYPTO_LZ4HC is not set
-
-#
-# Random Number Generation
-#
-# CONFIG_CRYPTO_ANSI_CPRNG is not set
-CONFIG_CRYPTO_DRBG_MENU=y
-CONFIG_CRYPTO_DRBG_HMAC=y
-# CONFIG_CRYPTO_DRBG_HASH is not set
-# CONFIG_CRYPTO_DRBG_CTR is not set
-CONFIG_CRYPTO_DRBG=y
-CONFIG_CRYPTO_JITTERENTROPY=y
-# CONFIG_CRYPTO_USER_API_HASH is not set
-# CONFIG_CRYPTO_USER_API_SKCIPHER is not set
-# CONFIG_CRYPTO_USER_API_RNG is not set
-# CONFIG_CRYPTO_USER_API_AEAD is not set
-# CONFIG_CRYPTO_HW is not set
-# CONFIG_ASYMMETRIC_KEY_TYPE is not set
-
-#
-# Certificates for signature checking
-#
-# CONFIG_ARM_CRYPTO is not set
-# CONFIG_BINARY_PRINTF is not set
-
-#
-# Library routines
-#
-CONFIG_BITREVERSE=y
-CONFIG_HAVE_ARCH_BITREVERSE=y
-CONFIG_RATIONAL=y
-CONFIG_GENERIC_STRNCPY_FROM_USER=y
-CONFIG_GENERIC_STRNLEN_USER=y
-CONFIG_GENERIC_NET_UTILS=y
-CONFIG_GENERIC_PCI_IOMAP=y
-CONFIG_GENERIC_IO=y
-CONFIG_ARCH_USE_CMPXCHG_LOCKREF=y
-# CONFIG_CRC_CCITT is not set
-CONFIG_CRC16=y
-# CONFIG_CRC_T10DIF is not set
-# CONFIG_CRC_ITU_T is not set
-CONFIG_CRC32=y
-# CONFIG_CRC32_SELFTEST is not set
-CONFIG_CRC32_SLICEBY8=y
-# CONFIG_CRC32_SLICEBY4 is not set
-# CONFIG_CRC32_SARWATE is not set
-# CONFIG_CRC32_BIT is not set
-# CONFIG_CRC7 is not set
-# CONFIG_LIBCRC32C is not set
-# CONFIG_CRC8 is not set
-# CONFIG_AUDIT_ARCH_COMPAT_GENERIC is not set
-# CONFIG_RANDOM32_SELFTEST is not set
-CONFIG_ZLIB_INFLATE=y
-CONFIG_ZLIB_DEFLATE=y
-CONFIG_LZO_COMPRESS=y
-CONFIG_LZO_DECOMPRESS=y
-CONFIG_XZ_DEC=y
-# CONFIG_XZ_DEC_X86 is not set
-# CONFIG_XZ_DEC_POWERPC is not set
-# CONFIG_XZ_DEC_IA64 is not set
-CONFIG_XZ_DEC_ARM=y
-CONFIG_XZ_DEC_ARMTHUMB=y
-# CONFIG_XZ_DEC_SPARC is not set
-CONFIG_XZ_DEC_BCJ=y
-# CONFIG_XZ_DEC_TEST is not set
-CONFIG_GENERIC_ALLOCATOR=y
-CONFIG_ASSOCIATIVE_ARRAY=y
-CONFIG_HAS_IOMEM=y
-CONFIG_HAS_IOPORT_MAP=y
-CONFIG_HAS_DMA=y
-CONFIG_DQL=y
-CONFIG_NLATTR=y
-# CONFIG_CORDIC is not set
-# CONFIG_DDR is not set
-# CONFIG_IRQ_POLL is not set
-CONFIG_LIBFDT=y
-CONFIG_OID_REGISTRY=y
-# CONFIG_SG_SPLIT is not set
-CONFIG_SG_POOL=y
-CONFIG_ARCH_HAS_SG_CHAIN=y
-CONFIG_SBITMAP=y
-# CONFIG_VIRTUALIZATION is not set
diff --git a/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335.generic.config.tiandy b/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335.generic.config.tiandy
deleted file mode 100644
index 247a06b1..00000000
--- a/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335.generic.config.tiandy
+++ /dev/null
@@ -1,2652 +0,0 @@
-#
-# Automatically generated file; DO NOT EDIT.
-# Linux/arm 4.9.84 Kernel Configuration
-#
-CONFIG_ARM=y
-CONFIG_ARM_HAS_SG_CHAIN=y
-CONFIG_MIGHT_HAVE_PCI=y
-CONFIG_SYS_SUPPORTS_APM_EMULATION=y
-CONFIG_HAVE_PROC_CPU=y
-CONFIG_STACKTRACE_SUPPORT=y
-CONFIG_LOCKDEP_SUPPORT=y
-CONFIG_TRACE_IRQFLAGS_SUPPORT=y
-CONFIG_RWSEM_XCHGADD_ALGORITHM=y
-CONFIG_FIX_EARLYCON_MEM=y
-CONFIG_GENERIC_HWEIGHT=y
-CONFIG_GENERIC_CALIBRATE_DELAY=y
-CONFIG_NEED_DMA_MAP_STATE=y
-CONFIG_ARCH_SUPPORTS_UPROBES=y
-CONFIG_VECTORS_BASE=0xffff0000
-CONFIG_ARM_PATCH_PHYS_VIRT=y
-CONFIG_GENERIC_BUG=y
-CONFIG_PGTABLE_LEVELS=2
-CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config"
-CONFIG_IRQ_WORK=y
-CONFIG_BUILDTIME_EXTABLE_SORT=y
-
-#
-# General setup
-#
-CONFIG_BROKEN_ON_SMP=y
-CONFIG_INIT_ENV_ARG_LIMIT=32
-CONFIG_CROSS_COMPILE=""
-# CONFIG_COMPILE_TEST is not set
-CONFIG_LOCALVERSION=""
-# CONFIG_LOCALVERSION_AUTO is not set
-CONFIG_HAVE_KERNEL_GZIP=y
-CONFIG_HAVE_KERNEL_LZMA=y
-CONFIG_HAVE_KERNEL_XZ=y
-CONFIG_HAVE_KERNEL_LZO=y
-CONFIG_HAVE_KERNEL_LZ4=y
-# CONFIG_KERNEL_GZIP is not set
-# CONFIG_KERNEL_LZMA is not set
-CONFIG_KERNEL_XZ=y
-# CONFIG_KERNEL_LZO is not set
-# CONFIG_KERNEL_LZ4 is not set
-CONFIG_DEFAULT_HOSTNAME="ipcam"
-# CONFIG_SWAP is not set
-CONFIG_SYSVIPC=y
-CONFIG_SYSVIPC_SYSCTL=y
-CONFIG_POSIX_MQUEUE=y
-CONFIG_POSIX_MQUEUE_SYSCTL=y
-# CONFIG_CROSS_MEMORY_ATTACH is not set
-# CONFIG_FHANDLE is not set
-# CONFIG_USELIB is not set
-# CONFIG_AUDIT is not set
-CONFIG_HAVE_ARCH_AUDITSYSCALL=y
-
-#
-# IRQ subsystem
-#
-CONFIG_GENERIC_IRQ_PROBE=y
-CONFIG_GENERIC_IRQ_SHOW=y
-CONFIG_GENERIC_IRQ_SHOW_LEVEL=y
-CONFIG_HARDIRQS_SW_RESEND=y
-CONFIG_IRQ_DOMAIN=y
-CONFIG_IRQ_DOMAIN_HIERARCHY=y
-CONFIG_HANDLE_DOMAIN_IRQ=y
-# CONFIG_IRQ_DOMAIN_DEBUG is not set
-CONFIG_IRQ_FORCED_THREADING=y
-CONFIG_SPARSE_IRQ=y
-CONFIG_ARCH_CLOCKSOURCE_DATA=y
-CONFIG_GENERIC_TIME_VSYSCALL=y
-CONFIG_GENERIC_CLOCKEVENTS=y
-
-#
-# Timers subsystem
-#
-CONFIG_TICK_ONESHOT=y
-CONFIG_NO_HZ_COMMON=y
-# CONFIG_HZ_PERIODIC is not set
-CONFIG_NO_HZ_IDLE=y
-CONFIG_NO_HZ=y
-CONFIG_HIGH_RES_TIMERS=y
-
-#
-# CPU/Task time and stats accounting
-#
-CONFIG_TICK_CPU_ACCOUNTING=y
-# CONFIG_VIRT_CPU_ACCOUNTING_GEN is not set
-# CONFIG_IRQ_TIME_ACCOUNTING is not set
-# CONFIG_BSD_PROCESS_ACCT is not set
-# CONFIG_TASKSTATS is not set
-
-#
-# RCU Subsystem
-#
-CONFIG_PREEMPT_RCU=y
-# CONFIG_RCU_EXPERT is not set
-CONFIG_SRCU=y
-# CONFIG_TASKS_RCU is not set
-CONFIG_RCU_STALL_COMMON=y
-# CONFIG_TREE_RCU_TRACE is not set
-# CONFIG_RCU_EXPEDITE_BOOT is not set
-# CONFIG_BUILD_BIN2C is not set
-# CONFIG_IKCONFIG is not set
-CONFIG_LOG_BUF_SHIFT=15
-CONFIG_NMI_LOG_BUF_SHIFT=13
-CONFIG_GENERIC_SCHED_CLOCK=y
-CONFIG_CGROUPS=y
-# CONFIG_MEMCG is not set
-# CONFIG_BLK_CGROUP is not set
-# CONFIG_CGROUP_SCHED is not set
-# CONFIG_CGROUP_PIDS is not set
-# CONFIG_CGROUP_FREEZER is not set
-# CONFIG_CPUSETS is not set
-# CONFIG_CGROUP_DEVICE is not set
-# CONFIG_CGROUP_CPUACCT is not set
-# CONFIG_CGROUP_PERF is not set
-# CONFIG_CGROUP_DEBUG is not set
-# CONFIG_CHECKPOINT_RESTORE is not set
-CONFIG_NAMESPACES=y
-CONFIG_UTS_NS=y
-CONFIG_IPC_NS=y
-# CONFIG_USER_NS is not set
-CONFIG_PID_NS=y
-CONFIG_NET_NS=y
-# CONFIG_SCHED_AUTOGROUP is not set
-# CONFIG_SYSFS_DEPRECATED is not set
-# CONFIG_RELAY is not set
-CONFIG_BLK_DEV_INITRD=y
-CONFIG_INITRAMFS_SOURCE=""
-# CONFIG_RD_GZIP is not set
-# CONFIG_RD_BZIP2 is not set
-# CONFIG_RD_LZMA is not set
-# CONFIG_RD_XZ is not set
-# CONFIG_RD_LZO is not set
-# CONFIG_RD_LZ4 is not set
-# CONFIG_CC_OPTIMIZE_FOR_PERFORMANCE is not set
-CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-CONFIG_SYSCTL=y
-CONFIG_ANON_INODES=y
-CONFIG_HAVE_UID16=y
-CONFIG_BPF=y
-CONFIG_EXPERT=y
-CONFIG_UID16=y
-CONFIG_MULTIUSER=y
-# CONFIG_SGETMASK_SYSCALL is not set
-CONFIG_SYSFS_SYSCALL=y
-# CONFIG_SYSCTL_SYSCALL is not set
-CONFIG_KALLSYMS=y
-CONFIG_KALLSYMS_ALL=y
-# CONFIG_KALLSYMS_ABSOLUTE_PERCPU is not set
-CONFIG_KALLSYMS_BASE_RELATIVE=y
-CONFIG_PRINTK=y
-CONFIG_PRINTK_NMI=y
-CONFIG_BUG=y
-CONFIG_ELF_CORE=y
-# CONFIG_BASE_FULL is not set
-CONFIG_FUTEX=y
-CONFIG_EPOLL=y
-CONFIG_SIGNALFD=y
-CONFIG_TIMERFD=y
-CONFIG_EVENTFD=y
-# CONFIG_BPF_SYSCALL is not set
-CONFIG_SHMEM=y
-CONFIG_AIO=y
-# CONFIG_ADVISE_SYSCALLS is not set
-# CONFIG_USERFAULTFD is not set
-CONFIG_MEMBARRIER=y
-CONFIG_EMBEDDED=y
-CONFIG_HAVE_PERF_EVENTS=y
-CONFIG_PERF_USE_VMALLOC=y
-
-#
-# Kernel Performance Events And Counters
-#
-CONFIG_PERF_EVENTS=y
-# CONFIG_DEBUG_PERF_USE_VMALLOC is not set
-# CONFIG_VM_EVENT_COUNTERS is not set
-# CONFIG_SLUB_DEBUG is not set
-CONFIG_COMPAT_BRK=y
-# CONFIG_SLAB is not set
-CONFIG_SLUB=y
-# CONFIG_SLOB is not set
-# CONFIG_SLAB_FREELIST_RANDOM is not set
-# CONFIG_SYSTEM_DATA_VERIFICATION is not set
-# CONFIG_PROFILING is not set
-CONFIG_HAVE_OPROFILE=y
-# CONFIG_KPROBES is not set
-CONFIG_JUMP_LABEL=y
-# CONFIG_STATIC_KEYS_SELFTEST is not set
-# CONFIG_UPROBES is not set
-# CONFIG_HAVE_64BIT_ALIGNED_ACCESS is not set
-CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS=y
-CONFIG_ARCH_USE_BUILTIN_BSWAP=y
-CONFIG_HAVE_KPROBES=y
-CONFIG_HAVE_KRETPROBES=y
-CONFIG_HAVE_NMI=y
-CONFIG_HAVE_ARCH_TRACEHOOK=y
-CONFIG_HAVE_DMA_CONTIGUOUS=y
-CONFIG_GENERIC_SMP_IDLE_THREAD=y
-CONFIG_GENERIC_IDLE_POLL_SETUP=y
-CONFIG_HAVE_REGS_AND_STACK_ACCESS_API=y
-CONFIG_HAVE_CLK=y
-CONFIG_HAVE_DMA_API_DEBUG=y
-CONFIG_HAVE_HW_BREAKPOINT=y
-CONFIG_HAVE_PERF_REGS=y
-CONFIG_HAVE_PERF_USER_STACK_DUMP=y
-CONFIG_HAVE_ARCH_JUMP_LABEL=y
-CONFIG_ARCH_WANT_IPC_PARSE_VERSION=y
-CONFIG_HAVE_ARCH_SECCOMP_FILTER=y
-CONFIG_HAVE_GCC_PLUGINS=y
-# CONFIG_GCC_PLUGINS is not set
-CONFIG_HAVE_CC_STACKPROTECTOR=y
-CONFIG_CC_STACKPROTECTOR=y
-# CONFIG_CC_STACKPROTECTOR_NONE is not set
-CONFIG_CC_STACKPROTECTOR_REGULAR=y
-# CONFIG_CC_STACKPROTECTOR_STRONG is not set
-CONFIG_HAVE_CONTEXT_TRACKING=y
-CONFIG_HAVE_VIRT_CPU_ACCOUNTING_GEN=y
-CONFIG_HAVE_IRQ_TIME_ACCOUNTING=y
-CONFIG_HAVE_MOD_ARCH_SPECIFIC=y
-CONFIG_MODULES_USE_ELF_REL=y
-CONFIG_ARCH_HAS_ELF_RANDOMIZE=y
-CONFIG_HAVE_ARCH_MMAP_RND_BITS=y
-CONFIG_HAVE_EXIT_THREAD=y
-CONFIG_ARCH_MMAP_RND_BITS_MIN=8
-CONFIG_ARCH_MMAP_RND_BITS_MAX=16
-CONFIG_ARCH_MMAP_RND_BITS=8
-# CONFIG_HAVE_ARCH_HASH is not set
-# CONFIG_ISA_BUS_API is not set
-CONFIG_CLONE_BACKWARDS=y
-CONFIG_OLD_SIGSUSPEND3=y
-CONFIG_OLD_SIGACTION=y
-# CONFIG_CPU_NO_EFFICIENT_FFS is not set
-# CONFIG_HAVE_ARCH_VMAP_STACK is not set
-
-#
-# GCOV-based kernel profiling
-#
-# CONFIG_GCOV_KERNEL is not set
-CONFIG_ARCH_HAS_GCOV_PROFILE_ALL=y
-CONFIG_HAVE_GENERIC_DMA_COHERENT=y
-CONFIG_RT_MUTEXES=y
-CONFIG_BASE_SMALL=1
-CONFIG_MODULES=y
-CONFIG_MODULE_FORCE_LOAD=y
-CONFIG_MODULE_UNLOAD=y
-# CONFIG_MODULE_FORCE_UNLOAD is not set
-# CONFIG_MODVERSIONS is not set
-# CONFIG_MODULE_SRCVERSION_ALL is not set
-# CONFIG_MODULE_SIG is not set
-# CONFIG_MODULE_COMPRESS is not set
-# CONFIG_TRIM_UNUSED_KSYMS is not set
-CONFIG_MODULES_TREE_LOOKUP=y
-CONFIG_BLOCK=y
-# CONFIG_LBDAF is not set
-# CONFIG_BLK_DEV_BSG is not set
-# CONFIG_BLK_DEV_BSGLIB is not set
-# CONFIG_BLK_DEV_INTEGRITY is not set
-# CONFIG_BLK_CMDLINE_PARSER is not set
-
-#
-# Partition Types
-#
-# CONFIG_PARTITION_ADVANCED is not set
-CONFIG_MSDOS_PARTITION=y
-CONFIG_EFI_PARTITION=y
-
-#
-# IO Schedulers
-#
-CONFIG_IOSCHED_NOOP=y
-CONFIG_IOSCHED_DEADLINE=y
-# CONFIG_IOSCHED_CFQ is not set
-CONFIG_DEFAULT_DEADLINE=y
-# CONFIG_DEFAULT_NOOP is not set
-CONFIG_DEFAULT_IOSCHED="deadline"
-CONFIG_UNINLINE_SPIN_UNLOCK=y
-CONFIG_ARCH_SUPPORTS_ATOMIC_RMW=y
-# CONFIG_FREEZER is not set
-
-#
-# System Type
-#
-CONFIG_MMU=y
-# CONFIG_ARCH_INFINITY2 is not set
-CONFIG_ARCH_MULTIPLATFORM=y
-# CONFIG_ARCH_GEMINI is not set
-# CONFIG_ARCH_EBSA110 is not set
-# CONFIG_ARCH_EP93XX is not set
-# CONFIG_ARCH_FOOTBRIDGE is not set
-# CONFIG_ARCH_NETX is not set
-# CONFIG_ARCH_IOP13XX is not set
-# CONFIG_ARCH_IOP32X is not set
-# CONFIG_ARCH_IOP33X is not set
-# CONFIG_ARCH_IXP4XX is not set
-# CONFIG_ARCH_DOVE is not set
-# CONFIG_ARCH_KS8695 is not set
-# CONFIG_ARCH_W90X900 is not set
-# CONFIG_ARCH_LPC32XX is not set
-# CONFIG_ARCH_PXA is not set
-# CONFIG_ARCH_RPC is not set
-# CONFIG_ARCH_SA1100 is not set
-# CONFIG_ARCH_S3C24XX is not set
-# CONFIG_ARCH_DAVINCI is not set
-# CONFIG_ARCH_OMAP1 is not set
-
-#
-# Multiple platform selection
-#
-
-#
-# CPU Core family selection
-#
-# CONFIG_ARCH_MULTI_V6 is not set
-CONFIG_ARCH_MULTI_V7=y
-CONFIG_ARCH_MULTI_V6_V7=y
-# CONFIG_ARCH_MULTI_CPU_AUTO is not set
-# CONFIG_ARCH_VIRT is not set
-# CONFIG_ARCH_MVEBU is not set
-# CONFIG_ARCH_ALPINE is not set
-# CONFIG_ARCH_ARTPEC is not set
-# CONFIG_ARCH_AT91 is not set
-# CONFIG_ARCH_BCM is not set
-# CONFIG_ARCH_BERLIN is not set
-# CONFIG_ARCH_DIGICOLOR is not set
-# CONFIG_ARCH_HIGHBANK is not set
-# CONFIG_ARCH_HISI is not set
-# CONFIG_ARCH_KEYSTONE is not set
-# CONFIG_ARCH_MESON is not set
-CONFIG_ARCH_SSTAR=y
-# CONFIG_SS_DUALOS is not set
-
-#
-# Options
-#
-CONFIG_SS_DTB_NAME="infinity6b0-ssc009a-s01a-qfn88-tiandy"
-CONFIG_SS_BUILTIN_DTB=y
-CONFIG_MS_KERNEL_TYPE=""
-CONFIG_SSTAR_CHIP_NAME="infinity6b0"
-CONFIG_SSTAR_SHORT_NAME="I6B0"
-# CONFIG_MP_IRQ_TRACE is not set
-CONFIG_SKIP_SQUASHFS_BAD_BLOCK=y
-
-#
-# Fast boot
-#
-# CONFIG_SS_BUILTIN_UNFDT is not set
-# CONFIG_FB_DTS_SKIP_CRC is not set
-# CONFIG_FB_DTS_SCAN_MEMORY_ONCE is not set
-# CONFIG_FB_DTS_SKIP_ATAGS_TO_FDT is not set
-CONFIG_DISABLE_CLK_DEBUGFS_SUPPORT=y
-CONFIG_DEFERRED_INIICALLS=y
-# CONFIG_DEFERRED_INIICALLS_SLAB_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_PARAM_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_PPERF_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_MORE_SYSFS is not set
-# CONFIG_DEFERRED_CREATE_DTS_SYSNODE is not set
-# CONFIG_CRYPTO_MANAGER_NO_TESTS_THREAD is not set
-CONFIG_ARCH_INFINITY6B0=y
-CONFIG_SS_PROFILING_TIME=y
-# CONFIG_ARCH_MXC is not set
-# CONFIG_ARCH_MEDIATEK is not set
-
-#
-# TI OMAP/AM/DM/DRA Family
-#
-# CONFIG_ARCH_OMAP3 is not set
-# CONFIG_ARCH_OMAP4 is not set
-# CONFIG_SOC_OMAP5 is not set
-# CONFIG_SOC_AM33XX is not set
-# CONFIG_SOC_AM43XX is not set
-# CONFIG_SOC_DRA7XX is not set
-# CONFIG_ARCH_MMP is not set
-# CONFIG_ARCH_QCOM is not set
-# CONFIG_ARCH_REALVIEW is not set
-# CONFIG_ARCH_ROCKCHIP is not set
-# CONFIG_ARCH_SOCFPGA is not set
-# CONFIG_PLAT_SPEAR is not set
-# CONFIG_ARCH_STI is not set
-# CONFIG_ARCH_S5PV210 is not set
-# CONFIG_ARCH_EXYNOS is not set
-# CONFIG_ARCH_RENESAS is not set
-# CONFIG_ARCH_SUNXI is not set
-# CONFIG_ARCH_SIRF is not set
-# CONFIG_ARCH_TANGO is not set
-# CONFIG_ARCH_TEGRA is not set
-# CONFIG_ARCH_UNIPHIER is not set
-# CONFIG_ARCH_U8500 is not set
-# CONFIG_ARCH_VEXPRESS is not set
-# CONFIG_ARCH_WM8850 is not set
-# CONFIG_ARCH_ZX is not set
-# CONFIG_ARCH_ZYNQ is not set
-
-#
-# Processor Type
-#
-CONFIG_CPU_V7=y
-CONFIG_CPU_32v6K=y
-CONFIG_CPU_32v7=y
-CONFIG_CPU_ABRT_EV7=y
-CONFIG_CPU_PABRT_V7=y
-CONFIG_CPU_CACHE_V7=y
-CONFIG_CPU_CACHE_VIPT=y
-CONFIG_CPU_COPY_V6=y
-CONFIG_CPU_TLB_V7=y
-CONFIG_CPU_HAS_ASID=y
-CONFIG_CPU_CP15=y
-CONFIG_CPU_CP15_MMU=y
-
-#
-# Processor Features
-#
-# CONFIG_ARM_LPAE is not set
-# CONFIG_ARCH_PHYS_ADDR_T_64BIT is not set
-CONFIG_ARM_THUMB=y
-CONFIG_ARM_THUMBEE=y
-CONFIG_ARM_VIRT_EXT=y
-# CONFIG_SWP_EMULATE is not set
-# CONFIG_CPU_ICACHE_DISABLE is not set
-# CONFIG_CPU_DCACHE_DISABLE is not set
-# CONFIG_CPU_BPREDICT_DISABLE is not set
-CONFIG_KUSER_HELPERS=y
-CONFIG_VDSO=y
-CONFIG_MIGHT_HAVE_CACHE_L2X0=y
-# CONFIG_CACHE_L2X0 is not set
-CONFIG_ARM_L1_CACHE_SHIFT_6=y
-CONFIG_ARM_L1_CACHE_SHIFT=6
-CONFIG_ARM_DMA_MEM_BUFFERABLE=y
-# CONFIG_DEBUG_RODATA is not set
-CONFIG_MULTI_IRQ_HANDLER=y
-# CONFIG_ARM_ERRATA_430973 is not set
-# CONFIG_ARM_ERRATA_720789 is not set
-# CONFIG_ARM_ERRATA_754322 is not set
-# CONFIG_ARM_ERRATA_775420 is not set
-# CONFIG_ARM_ERRATA_773022 is not set
-# CONFIG_ARM_ERRATA_818325_852422 is not set
-# CONFIG_ARM_ERRATA_821420 is not set
-# CONFIG_ARM_ERRATA_825619 is not set
-# CONFIG_ARM_ERRATA_852421 is not set
-# CONFIG_ARM_ERRATA_852423 is not set
-
-#
-# Bus support
-#
-# CONFIG_PCI is not set
-# CONFIG_PCI_DOMAINS_GENERIC is not set
-# CONFIG_PCI_SYSCALL is not set
-# CONFIG_PCCARD is not set
-
-#
-# Kernel Features
-#
-CONFIG_HAVE_SMP=y
-# CONFIG_SMP is not set
-CONFIG_HAVE_ARM_ARCH_TIMER=y
-CONFIG_VMSPLIT_3G=y
-# CONFIG_VMSPLIT_3G_OPT is not set
-# CONFIG_VMSPLIT_2G is not set
-# CONFIG_VMSPLIT_1G is not set
-CONFIG_PAGE_OFFSET=0xC0000000
-# CONFIG_ARM_PSCI is not set
-CONFIG_ARCH_NR_GPIO=0
-# CONFIG_PREEMPT_NONE is not set
-# CONFIG_PREEMPT_VOLUNTARY is not set
-CONFIG_PREEMPT=y
-CONFIG_PREEMPT_COUNT=y
-CONFIG_HZ_FIXED=0
-CONFIG_HZ_100=y
-# CONFIG_HZ_200 is not set
-# CONFIG_HZ_250 is not set
-# CONFIG_HZ_300 is not set
-# CONFIG_HZ_500 is not set
-# CONFIG_HZ_1000 is not set
-CONFIG_HZ=100
-CONFIG_SCHED_HRTICK=y
-CONFIG_THUMB2_KERNEL=y
-CONFIG_THUMB2_AVOID_R_ARM_THM_JUMP11=y
-CONFIG_ARM_ASM_UNIFIED=y
-CONFIG_ARM_PATCH_IDIV=y
-CONFIG_AEABI=y
-# CONFIG_ARCH_SPARSEMEM_DEFAULT is not set
-# CONFIG_ARCH_SELECT_MEMORY_MODEL is not set
-CONFIG_HAVE_ARCH_PFN_VALID=y
-# CONFIG_HIGHMEM is not set
-CONFIG_CPU_SW_DOMAIN_PAN=y
-CONFIG_HW_PERF_EVENTS=y
-CONFIG_ARCH_WANT_GENERAL_HUGETLB=y
-# CONFIG_ARM_MODULE_PLTS is not set
-CONFIG_FLATMEM=y
-CONFIG_FLAT_NODE_MEM_MAP=y
-CONFIG_HAVE_MEMBLOCK=y
-CONFIG_NO_BOOTMEM=y
-CONFIG_MEMORY_ISOLATION=y
-# CONFIG_HAVE_BOOTMEM_INFO_NODE is not set
-CONFIG_SPLIT_PTLOCK_CPUS=4
-CONFIG_COMPACTION=y
-CONFIG_MIGRATION=y
-# CONFIG_PHYS_ADDR_T_64BIT is not set
-# CONFIG_KSM is not set
-CONFIG_DEFAULT_MMAP_MIN_ADDR=4096
-CONFIG_NEED_PER_CPU_KM=y
-# CONFIG_CLEANCACHE is not set
-CONFIG_CMA=y
-CONFIG_CMA_DEBUG=y
-CONFIG_CMA_DEBUGFS=y
-CONFIG_CMA_AREAS=1
-# CONFIG_ZPOOL is not set
-# CONFIG_ZBUD is not set
-# CONFIG_ZSMALLOC is not set
-CONFIG_GENERIC_EARLY_IOREMAP=y
-# CONFIG_IDLE_PAGE_TRACKING is not set
-CONFIG_FORCE_MAX_ZONEORDER=10
-CONFIG_ALIGNMENT_TRAP=y
-# CONFIG_UACCESS_WITH_MEMCPY is not set
-# CONFIG_SECCOMP is not set
-CONFIG_SWIOTLB=y
-CONFIG_IOMMU_HELPER=y
-# CONFIG_PARAVIRT is not set
-# CONFIG_PARAVIRT_TIME_ACCOUNTING is not set
-# CONFIG_XEN is not set
-
-#
-# Boot options
-#
-CONFIG_USE_OF=y
-CONFIG_ATAGS=y
-# CONFIG_DEPRECATED_PARAM_STRUCT is not set
-CONFIG_ZBOOT_ROM_TEXT=0
-CONFIG_ZBOOT_ROM_BSS=0
-CONFIG_ARM_APPENDED_DTB=y
-CONFIG_ARM_ATAG_DTB_COMPAT=y
-CONFIG_ARM_ATAG_DTB_COMPAT_CMDLINE_FROM_BOOTLOADER=y
-# CONFIG_ARM_ATAG_DTB_COMPAT_CMDLINE_EXTEND is not set
-CONFIG_CMDLINE=""
-# CONFIG_KEXEC is not set
-# CONFIG_CRASH_DUMP is not set
-CONFIG_AUTO_ZRELADDR=y
-# CONFIG_EFI is not set
-
-#
-# CPU Power Management
-#
-
-#
-# CPU Frequency scaling
-#
-CONFIG_CPU_FREQ=y
-CONFIG_CPU_FREQ_GOV_ATTR_SET=y
-CONFIG_CPU_FREQ_GOV_COMMON=y
-CONFIG_CPU_FREQ_STAT=y
-CONFIG_CPU_FREQ_STAT_DETAILS=y
-# CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE is not set
-# CONFIG_CPU_FREQ_DEFAULT_GOV_POWERSAVE is not set
-# CONFIG_CPU_FREQ_DEFAULT_GOV_USERSPACE is not set
-CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND=y
-# CONFIG_CPU_FREQ_DEFAULT_GOV_CONSERVATIVE is not set
-CONFIG_CPU_FREQ_GOV_PERFORMANCE=y
-CONFIG_CPU_FREQ_GOV_POWERSAVE=y
-CONFIG_CPU_FREQ_GOV_USERSPACE=y
-CONFIG_CPU_FREQ_GOV_ONDEMAND=y
-# CONFIG_CPU_FREQ_GOV_CONSERVATIVE is not set
-
-#
-# CPU frequency scaling drivers
-#
-# CONFIG_CPUFREQ_DT is not set
-# CONFIG_ARM_KIRKWOOD_CPUFREQ is not set
-# CONFIG_QORIQ_CPUFREQ is not set
-
-#
-# CPU Idle
-#
-# CONFIG_CPU_IDLE is not set
-# CONFIG_ARCH_NEEDS_CPU_IDLE_COUPLED is not set
-
-#
-# Floating point emulation
-#
-
-#
-# At least one emulation must be selected
-#
-CONFIG_VFP=y
-CONFIG_VFPv3=y
-CONFIG_NEON=y
-CONFIG_KERNEL_MODE_NEON=y
-
-#
-# Userspace binary formats
-#
-CONFIG_BINFMT_ELF=y
-CONFIG_ELFCORE=y
-CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS=y
-CONFIG_BINFMT_SCRIPT=y
-# CONFIG_BINFMT_FLAT is not set
-# CONFIG_HAVE_AOUT is not set
-# CONFIG_BINFMT_MISC is not set
-CONFIG_COREDUMP=y
-
-#
-# Power management options
-#
-# CONFIG_SUSPEND is not set
-# CONFIG_PM is not set
-# CONFIG_APM_EMULATION is not set
-CONFIG_PM_OPP=y
-CONFIG_ARCH_SUSPEND_POSSIBLE=y
-# CONFIG_ARM_CPU_SUSPEND is not set
-CONFIG_ARCH_HIBERNATION_POSSIBLE=y
-CONFIG_NET=y
-
-#
-# Networking options
-#
-CONFIG_PACKET=y
-# CONFIG_PACKET_DIAG is not set
-CONFIG_UNIX=y
-# CONFIG_UNIX_DIAG is not set
-# CONFIG_XFRM_USER is not set
-# CONFIG_NET_KEY is not set
-CONFIG_INET=y
-CONFIG_IP_MULTICAST=y
-CONFIG_IP_ADVANCED_ROUTER=y
-# CONFIG_IP_FIB_TRIE_STATS is not set
-# CONFIG_IP_MULTIPLE_TABLES is not set
-CONFIG_IP_ROUTE_MULTIPATH=y
-CONFIG_IP_ROUTE_VERBOSE=y
-CONFIG_IP_PNP=y
-CONFIG_IP_PNP_DHCP=y
-# CONFIG_NET_IPIP is not set
-# CONFIG_NET_IPGRE_DEMUX is not set
-# CONFIG_NET_IP_TUNNEL is not set
-# CONFIG_IP_MROUTE is not set
-CONFIG_SYN_COOKIES=y
-# CONFIG_NET_UDP_TUNNEL is not set
-# CONFIG_NET_FOU is not set
-# CONFIG_INET_AH is not set
-# CONFIG_INET_ESP is not set
-# CONFIG_INET_IPCOMP is not set
-# CONFIG_INET_XFRM_TUNNEL is not set
-# CONFIG_INET_TUNNEL is not set
-# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-# CONFIG_INET_XFRM_MODE_BEET is not set
-# CONFIG_INET_DIAG is not set
-# CONFIG_TCP_CONG_ADVANCED is not set
-# CONFIG_TCP_CONG_BIC is not set
-CONFIG_TCP_CONG_CUBIC=y
-# CONFIG_TCP_CONG_WESTWOOD is not set
-# CONFIG_TCP_CONG_HTCP is not set
-# CONFIG_TCP_CONG_HSTCP is not set
-# CONFIG_TCP_CONG_HYBLA is not set
-# CONFIG_TCP_CONG_VEGAS is not set
-# CONFIG_TCP_CONG_NV is not set
-# CONFIG_TCP_CONG_SCALABLE is not set
-# CONFIG_TCP_CONG_LP is not set
-# CONFIG_TCP_CONG_VENO is not set
-# CONFIG_TCP_CONG_YEAH is not set
-# CONFIG_TCP_CONG_ILLINOIS is not set
-# CONFIG_TCP_CONG_DCTCP is not set
-# CONFIG_TCP_CONG_CDG is not set
-# CONFIG_TCP_CONG_BBR is not set
-CONFIG_DEFAULT_CUBIC=y
-# CONFIG_DEFAULT_RENO is not set
-CONFIG_DEFAULT_TCP_CONG="cubic"
-# CONFIG_TCP_MD5SIG is not set
-# CONFIG_IPV6 is not set
-# CONFIG_NETWORK_SECMARK is not set
-# CONFIG_NET_PTP_CLASSIFY is not set
-# CONFIG_NETWORK_PHY_TIMESTAMPING is not set
-# CONFIG_NETFILTER is not set
-# CONFIG_IP_DCCP is not set
-# CONFIG_IP_SCTP is not set
-# CONFIG_RDS is not set
-# CONFIG_TIPC is not set
-# CONFIG_ATM is not set
-# CONFIG_L2TP is not set
-CONFIG_BRIDGE=y
-CONFIG_HAVE_NET_DSA=y
-# CONFIG_NET_DSA is not set
-# CONFIG_VLAN_8021Q is not set
-# CONFIG_DECNET is not set
-# CONFIG_LLC2 is not set
-# CONFIG_IPX is not set
-# CONFIG_ATALK is not set
-# CONFIG_X25 is not set
-# CONFIG_LAPB is not set
-# CONFIG_PHONET is not set
-# CONFIG_IEEE802154 is not set
-# CONFIG_NET_SCHED is not set
-# CONFIG_DCB is not set
-# CONFIG_BATMAN_ADV is not set
-# CONFIG_OPENVSWITCH is not set
-# CONFIG_VSOCKETS is not set
-# CONFIG_NETLINK_DIAG is not set
-# CONFIG_MPLS is not set
-# CONFIG_HSR is not set
-# CONFIG_NET_SWITCHDEV is not set
-# CONFIG_NET_L3_MASTER_DEV is not set
-# CONFIG_NET_NCSI is not set
-# CONFIG_SOCK_CGROUP_DATA is not set
-# CONFIG_CGROUP_NET_PRIO is not set
-# CONFIG_CGROUP_NET_CLASSID is not set
-CONFIG_NET_RX_BUSY_POLL=y
-CONFIG_BQL=y
-# CONFIG_BPF_JIT is not set
-
-#
-# Network testing
-#
-# CONFIG_NET_PKTGEN is not set
-# CONFIG_HAMRADIO is not set
-# CONFIG_CAN is not set
-# CONFIG_IRDA is not set
-# CONFIG_BT is not set
-# CONFIG_AF_RXRPC is not set
-# CONFIG_AF_KCM is not set
-# CONFIG_STREAM_PARSER is not set
-CONFIG_WIRELESS=y
-CONFIG_WIRELESS_EXT=y
-CONFIG_WEXT_CORE=y
-CONFIG_WEXT_PROC=y
-CONFIG_WEXT_PRIV=y
-CONFIG_CFG80211=m
-# CONFIG_NL80211_TESTMODE is not set
-# CONFIG_CFG80211_DEVELOPER_WARNINGS is not set
-# CONFIG_CFG80211_CERTIFICATION_ONUS is not set
-CONFIG_CFG80211_DEFAULT_PS=y
-# CONFIG_CFG80211_DEBUGFS is not set
-# CONFIG_CFG80211_INTERNAL_REGDB is not set
-CONFIG_CFG80211_CRDA_SUPPORT=y
-CONFIG_CFG80211_WEXT=y
-# CONFIG_LIB80211 is not set
-CONFIG_MAC80211=m
-CONFIG_MAC80211_HAS_RC=y
-CONFIG_MAC80211_RC_MINSTREL=y
-CONFIG_MAC80211_RC_MINSTREL_HT=y
-# CONFIG_MAC80211_RC_MINSTREL_VHT is not set
-CONFIG_MAC80211_RC_DEFAULT_MINSTREL=y
-CONFIG_MAC80211_RC_DEFAULT="minstrel_ht"
-CONFIG_MAC80211_MESH=y
-# CONFIG_MAC80211_DEBUGFS is not set
-# CONFIG_MAC80211_MESSAGE_TRACING is not set
-# CONFIG_MAC80211_DEBUG_MENU is not set
-CONFIG_MAC80211_STA_HASH_MAX_SIZE=0
-# CONFIG_WIMAX is not set
-CONFIG_RFKILL=y
-CONFIG_RFKILL_GPIO=y
-# CONFIG_NET_9P is not set
-# CONFIG_CAIF is not set
-# CONFIG_CEPH_LIB is not set
-# CONFIG_NFC is not set
-# CONFIG_LWTUNNEL is not set
-# CONFIG_DST_CACHE is not set
-# CONFIG_NET_DEVLINK is not set
-CONFIG_MAY_USE_DEVLINK=y
-CONFIG_HAVE_CBPF_JIT=y
-
-#
-# Device Drivers
-#
-
-#
-# Generic Driver Options
-#
-CONFIG_UEVENT_HELPER=y
-CONFIG_UEVENT_HELPER_PATH="/sbin/mdev"
-CONFIG_DEVTMPFS=y
-CONFIG_DEVTMPFS_MOUNT=y
-# CONFIG_STANDALONE is not set
-# CONFIG_PREVENT_FIRMWARE_BUILD is not set
-# CONFIG_FW_LOADER is not set
-# CONFIG_ALLOW_DEV_COREDUMP is not set
-# CONFIG_DEBUG_DRIVER is not set
-# CONFIG_DEBUG_DEVRES is not set
-# CONFIG_DEBUG_TEST_DRIVER_REMOVE is not set
-# CONFIG_SYS_HYPERVISOR is not set
-# CONFIG_GENERIC_CPU_DEVICES is not set
-CONFIG_SOC_BUS=y
-CONFIG_REGMAP=y
-CONFIG_REGMAP_I2C=y
-CONFIG_REGMAP_SPI=y
-# CONFIG_DMA_SHARED_BUFFER is not set
-CONFIG_DMA_CMA=y
-
-#
-# Default contiguous memory area size:
-#
-CONFIG_CMA_SIZE_MBYTES=2
-CONFIG_CMA_SIZE_SEL_MBYTES=y
-# CONFIG_CMA_SIZE_SEL_PERCENTAGE is not set
-# CONFIG_CMA_SIZE_SEL_MIN is not set
-# CONFIG_CMA_SIZE_SEL_MAX is not set
-CONFIG_CMA_ALIGNMENT=4
-
-#
-# Bus devices
-#
-# CONFIG_ARM_CCI400_PMU is not set
-# CONFIG_ARM_CCI5xx_PMU is not set
-# CONFIG_ARM_CCN is not set
-# CONFIG_BRCMSTB_GISB_ARB is not set
-# CONFIG_VEXPRESS_CONFIG is not set
-# CONFIG_CONNECTOR is not set
-CONFIG_MTD=y
-CONFIG_MTD_TESTS=m
-# CONFIG_MTD_SS_TESTS is not set
-# CONFIG_MTD_REDBOOT_PARTS is not set
-CONFIG_MTD_CMDLINE_PARTS=y
-# CONFIG_MTD_AFS_PARTS is not set
-# CONFIG_MTD_OF_PARTS is not set
-# CONFIG_MTD_AR7_PARTS is not set
-
-#
-# User Modules And Translation Layers
-#
-CONFIG_MTD_BLKDEVS=y
-CONFIG_MTD_BLOCK=y
-# CONFIG_FTL is not set
-# CONFIG_NFTL is not set
-# CONFIG_INFTL is not set
-# CONFIG_RFD_FTL is not set
-# CONFIG_SSFDC is not set
-# CONFIG_SM_FTL is not set
-# CONFIG_MTD_OOPS is not set
-# CONFIG_MTD_PARTITIONED_MASTER is not set
-
-#
-# RAM/ROM/Flash chip drivers
-#
-# CONFIG_MTD_CFI is not set
-# CONFIG_MTD_JEDECPROBE is not set
-CONFIG_MTD_MAP_BANK_WIDTH_1=y
-CONFIG_MTD_MAP_BANK_WIDTH_2=y
-CONFIG_MTD_MAP_BANK_WIDTH_4=y
-# CONFIG_MTD_MAP_BANK_WIDTH_8 is not set
-# CONFIG_MTD_MAP_BANK_WIDTH_16 is not set
-# CONFIG_MTD_MAP_BANK_WIDTH_32 is not set
-CONFIG_MTD_CFI_I1=y
-CONFIG_MTD_CFI_I2=y
-# CONFIG_MTD_CFI_I4 is not set
-# CONFIG_MTD_CFI_I8 is not set
-CONFIG_MTD_RAM=y
-# CONFIG_MTD_ROM is not set
-# CONFIG_MTD_ABSENT is not set
-
-#
-# Mapping drivers for chip access
-#
-# CONFIG_MTD_COMPLEX_MAPPINGS is not set
-CONFIG_MTD_PHYSMAP_OF=y
-CONFIG_MTD_PLATRAM=y
-
-#
-# Self-contained MTD device drivers
-#
-# CONFIG_MTD_DATAFLASH is not set
-# CONFIG_MTD_M25P80 is not set
-# CONFIG_MTD_SST25L is not set
-# CONFIG_MTD_SLRAM is not set
-# CONFIG_MTD_PHRAM is not set
-# CONFIG_MTD_MTDRAM is not set
-# CONFIG_MTD_BLOCK2MTD is not set
-
-#
-# Disk-On-Chip Device Drivers
-#
-# CONFIG_MTD_DOCG3 is not set
-CONFIG_MTD_NAND_ECC=m
-# CONFIG_MTD_NAND_ECC_SMC is not set
-CONFIG_MTD_NAND=m
-# CONFIG_MTD_NAND_ECC_BCH is not set
-# CONFIG_MTD_SM_COMMON is not set
-# CONFIG_MTD_NAND_DENALI_DT is not set
-# CONFIG_MTD_NAND_GPIO is not set
-# CONFIG_MTD_NAND_OMAP_BCH_BUILD is not set
-CONFIG_MTD_NAND_IDS=m
-# CONFIG_MTD_NAND_DISKONCHIP is not set
-# CONFIG_MTD_NAND_DOCG4 is not set
-# CONFIG_MTD_NAND_NANDSIM is not set
-# CONFIG_MTD_NAND_BRCMNAND is not set
-# CONFIG_MTD_NAND_PLATFORM is not set
-# CONFIG_MTD_NAND_HISI504 is not set
-# CONFIG_MTD_NAND_MTK is not set
-# CONFIG_MTD_ONENAND is not set
-
-#
-# LPDDR & LPDDR2 PCM memory drivers
-#
-# CONFIG_MTD_LPDDR is not set
-# CONFIG_MTD_LPDDR2_NVM is not set
-CONFIG_MTD_SPI_NOR=y
-# CONFIG_MTD_MT81xx_NOR is not set
-CONFIG_MTD_SPI_NOR_USE_4K_SECTORS=y
-# CONFIG_SPI_CADENCE_QUADSPI is not set
-CONFIG_MTD_UBI=y
-CONFIG_MTD_UBI_WL_THRESHOLD=4096
-CONFIG_MTD_UBI_BEB_LIMIT=20
-# CONFIG_MTD_UBI_FASTMAP is not set
-# CONFIG_MTD_UBI_GLUEBI is not set
-# CONFIG_MTD_UBI_BLOCK is not set
-CONFIG_DTC=y
-CONFIG_OF=y
-# CONFIG_OF_UNITTEST is not set
-CONFIG_OF_FLATTREE=y
-CONFIG_OF_EARLY_FLATTREE=y
-CONFIG_OF_ADDRESS=y
-CONFIG_OF_IRQ=y
-CONFIG_OF_NET=y
-CONFIG_OF_MDIO=y
-CONFIG_OF_RESERVED_MEM=y
-# CONFIG_OF_OVERLAY is not set
-CONFIG_ARCH_MIGHT_HAVE_PC_PARPORT=y
-# CONFIG_PARPORT is not set
-CONFIG_BLK_DEV=y
-# CONFIG_BLK_DEV_NULL_BLK is not set
-# CONFIG_BLK_DEV_COW_COMMON is not set
-CONFIG_BLK_DEV_LOOP=y
-# CONFIG_BLK_DEV_DRBD is not set
-# CONFIG_BLK_DEV_NBD is not set
-CONFIG_BLK_DEV_RAM=y
-CONFIG_BLK_DEV_RAM_COUNT=16
-CONFIG_BLK_DEV_RAM_SIZE=65536
-# CONFIG_CDROM_PKTCDVD is not set
-# CONFIG_ATA_OVER_ETH is not set
-# CONFIG_MG_DISK is not set
-# CONFIG_BLK_DEV_RBD is not set
-# CONFIG_NVME_TARGET is not set
-
-#
-# Misc devices
-#
-# CONFIG_AD525X_DPOT is not set
-# CONFIG_DUMMY_IRQ is not set
-# CONFIG_ICS932S401 is not set
-# CONFIG_ENCLOSURE_SERVICES is not set
-# CONFIG_APDS9802ALS is not set
-# CONFIG_ISL29003 is not set
-# CONFIG_ISL29020 is not set
-# CONFIG_SENSORS_TSL2550 is not set
-# CONFIG_SENSORS_BH1770 is not set
-# CONFIG_SENSORS_APDS990X is not set
-# CONFIG_HMC6352 is not set
-# CONFIG_DS1682 is not set
-# CONFIG_TI_DAC7512 is not set
-# CONFIG_USB_SWITCH_FSA9480 is not set
-# CONFIG_LATTICE_ECP3_CONFIG is not set
-# CONFIG_SRAM is not set
-# CONFIG_C2PORT is not set
-
-#
-# EEPROM support
-#
-CONFIG_EEPROM_AT24=m
-# CONFIG_EEPROM_AT25 is not set
-CONFIG_EEPROM_LEGACY=m
-# CONFIG_EEPROM_MAX6875 is not set
-# CONFIG_EEPROM_93CX6 is not set
-# CONFIG_EEPROM_93XX46 is not set
-
-#
-# Texas Instruments shared transport line discipline
-#
-# CONFIG_TI_ST is not set
-
-#
-# Altera FPGA firmware download module
-#
-# CONFIG_ALTERA_STAPL is not set
-
-#
-# Intel MIC Bus Driver
-#
-
-#
-# SCIF Bus Driver
-#
-
-#
-# VOP Bus Driver
-#
-
-#
-# Intel MIC Host Driver
-#
-
-#
-# Intel MIC Card Driver
-#
-
-#
-# SCIF Driver
-#
-
-#
-# Intel MIC Coprocessor State Management (COSM) Drivers
-#
-
-#
-# VOP Driver
-#
-# CONFIG_ECHO is not set
-# CONFIG_CXL_BASE is not set
-# CONFIG_CXL_AFU_DRIVER_OPS is not set
-
-#
-# SCSI device support
-#
-CONFIG_SCSI_MOD=y
-# CONFIG_RAID_ATTRS is not set
-CONFIG_SCSI=y
-CONFIG_SCSI_DMA=y
-# CONFIG_SCSI_NETLINK is not set
-# CONFIG_SCSI_MQ_DEFAULT is not set
-CONFIG_SCSI_PROC_FS=y
-
-#
-# SCSI support type (disk, tape, CD-ROM)
-#
-CONFIG_BLK_DEV_SD=y
-# CONFIG_CHR_DEV_ST is not set
-# CONFIG_CHR_DEV_OSST is not set
-# CONFIG_BLK_DEV_SR is not set
-# CONFIG_CHR_DEV_SG is not set
-# CONFIG_CHR_DEV_SCH is not set
-# CONFIG_SCSI_CONSTANTS is not set
-# CONFIG_SCSI_LOGGING is not set
-# CONFIG_SCSI_SCAN_ASYNC is not set
-
-#
-# SCSI Transports
-#
-# CONFIG_SCSI_SPI_ATTRS is not set
-# CONFIG_SCSI_FC_ATTRS is not set
-# CONFIG_SCSI_ISCSI_ATTRS is not set
-# CONFIG_SCSI_SAS_ATTRS is not set
-# CONFIG_SCSI_SAS_LIBSAS is not set
-# CONFIG_SCSI_SRP_ATTRS is not set
-CONFIG_SCSI_LOWLEVEL=y
-# CONFIG_ISCSI_TCP is not set
-# CONFIG_ISCSI_BOOT_SYSFS is not set
-# CONFIG_SCSI_UFSHCD is not set
-# CONFIG_SCSI_DEBUG is not set
-# CONFIG_SCSI_DH is not set
-# CONFIG_SCSI_OSD_INITIATOR is not set
-# CONFIG_ATA is not set
-# CONFIG_MD is not set
-# CONFIG_TARGET_CORE is not set
-CONFIG_NETDEVICES=y
-CONFIG_MII=y
-CONFIG_NET_CORE=y
-# CONFIG_BONDING is not set
-# CONFIG_DUMMY is not set
-# CONFIG_EQUALIZER is not set
-# CONFIG_NET_TEAM is not set
-# CONFIG_MACVLAN is not set
-# CONFIG_VXLAN is not set
-# CONFIG_MACSEC is not set
-# CONFIG_NETCONSOLE is not set
-# CONFIG_NETPOLL is not set
-# CONFIG_NET_POLL_CONTROLLER is not set
-CONFIG_TUN=m
-# CONFIG_TUN_VNET_CROSS_LE is not set
-# CONFIG_VETH is not set
-# CONFIG_NLMON is not set
-
-#
-# CAIF transport drivers
-#
-
-#
-# Distributed Switch Architecture drivers
-#
-# CONFIG_ETHERNET is not set
-CONFIG_PHYLIB=y
-CONFIG_SWPHY=y
-
-#
-# MDIO bus device drivers
-#
-# CONFIG_MDIO_BCM_UNIMAC is not set
-# CONFIG_MDIO_BITBANG is not set
-# CONFIG_MDIO_BUS_MUX_GPIO is not set
-# CONFIG_MDIO_BUS_MUX_MMIOREG is not set
-# CONFIG_MDIO_HISI_FEMAC is not set
-
-#
-# MII PHY device drivers
-#
-# CONFIG_AMD_PHY is not set
-# CONFIG_AQUANTIA_PHY is not set
-# CONFIG_AT803X_PHY is not set
-# CONFIG_BCM7XXX_PHY is not set
-# CONFIG_BCM87XX_PHY is not set
-# CONFIG_BROADCOM_PHY is not set
-# CONFIG_CICADA_PHY is not set
-# CONFIG_DAVICOM_PHY is not set
-# CONFIG_DP83848_PHY is not set
-# CONFIG_DP83867_PHY is not set
-CONFIG_FIXED_PHY=y
-# CONFIG_ICPLUS_PHY is not set
-# CONFIG_INTEL_XWAY_PHY is not set
-# CONFIG_LSI_ET1011C_PHY is not set
-# CONFIG_LXT_PHY is not set
-# CONFIG_MARVELL_PHY is not set
-# CONFIG_MICREL_PHY is not set
-# CONFIG_MICROCHIP_PHY is not set
-# CONFIG_MICROSEMI_PHY is not set
-# CONFIG_NATIONAL_PHY is not set
-# CONFIG_QSEMI_PHY is not set
-# CONFIG_REALTEK_PHY is not set
-# CONFIG_SMSC_PHY is not set
-# CONFIG_STE10XP is not set
-# CONFIG_TERANETICS_PHY is not set
-# CONFIG_VITESSE_PHY is not set
-# CONFIG_XILINX_GMII2RGMII is not set
-# CONFIG_MICREL_KS8995MA is not set
-# CONFIG_PPP is not set
-# CONFIG_SLIP is not set
-
-#
-# Host-side USB support is needed for USB Network Adapter support
-#
-CONFIG_USB_NET_DRIVERS=m
-# CONFIG_USB_CATC is not set
-# CONFIG_USB_KAWETH is not set
-# CONFIG_USB_PEGASUS is not set
-# CONFIG_USB_RTL8150 is not set
-# CONFIG_USB_RTL8152 is not set
-# CONFIG_USB_LAN78XX is not set
-CONFIG_USB_USBNET=m
-CONFIG_USB_NET_AX8817X=m
-CONFIG_USB_NET_AX88179_178A=m
-CONFIG_USB_NET_CDCETHER=m
-# CONFIG_USB_NET_CDC_EEM is not set
-CONFIG_USB_NET_CDC_NCM=m
-# CONFIG_USB_NET_HUAWEI_CDC_NCM is not set
-# CONFIG_USB_NET_CDC_MBIM is not set
-# CONFIG_USB_NET_DM9601 is not set
-# CONFIG_USB_NET_SR9700 is not set
-# CONFIG_USB_NET_SR9800 is not set
-# CONFIG_USB_NET_SMSC75XX is not set
-# CONFIG_USB_NET_SMSC95XX is not set
-# CONFIG_USB_NET_GL620A is not set
-CONFIG_USB_NET_NET1080=m
-# CONFIG_USB_NET_PLUSB is not set
-# CONFIG_USB_NET_MCS7830 is not set
-CONFIG_USB_NET_RNDIS_HOST=m
-CONFIG_USB_NET_CDC_SUBSET_ENABLE=m
-CONFIG_USB_NET_CDC_SUBSET=m
-# CONFIG_USB_ALI_M5632 is not set
-# CONFIG_USB_AN2720 is not set
-# CONFIG_USB_BELKIN is not set
-CONFIG_USB_ARMLINUX=y
-# CONFIG_USB_EPSON2888 is not set
-# CONFIG_USB_KC2190 is not set
-CONFIG_USB_NET_ZAURUS=m
-# CONFIG_USB_NET_CX82310_ETH is not set
-# CONFIG_USB_NET_KALMIA is not set
-# CONFIG_USB_NET_QMI_WWAN is not set
-# CONFIG_USB_NET_INT51X1 is not set
-# CONFIG_USB_IPHETH is not set
-# CONFIG_USB_SIERRA_NET is not set
-# CONFIG_USB_VL600 is not set
-# CONFIG_USB_NET_CH9200 is not set
-CONFIG_WLAN=y
-# CONFIG_WLAN_VENDOR_ADMTEK is not set
-# CONFIG_WLAN_VENDOR_ATH is not set
-# CONFIG_WLAN_VENDOR_ATMEL is not set
-# CONFIG_WLAN_VENDOR_BROADCOM is not set
-# CONFIG_WLAN_VENDOR_CISCO is not set
-# CONFIG_WLAN_VENDOR_INTEL is not set
-# CONFIG_WLAN_VENDOR_INTERSIL is not set
-# CONFIG_WLAN_VENDOR_MARVELL is not set
-CONFIG_WLAN_VENDOR_MEDIATEK=y
-# CONFIG_MT7601U is not set
-CONFIG_WLAN_VENDOR_RALINK=y
-# CONFIG_RT2X00 is not set
-CONFIG_WLAN_VENDOR_REALTEK=y
-# CONFIG_RTL8187 is not set
-# CONFIG_RTL_CARDS is not set
-# CONFIG_RTL8XXXU is not set
-# CONFIG_WLAN_VENDOR_RSI is not set
-# CONFIG_WLAN_VENDOR_ST is not set
-# CONFIG_WLAN_VENDOR_TI is not set
-# CONFIG_WLAN_VENDOR_ZYDAS is not set
-# CONFIG_MAC80211_HWSIM is not set
-CONFIG_USB_NET_RNDIS_WLAN=m
-
-#
-# Enable WiMAX (Networking options) to see the WiMAX drivers
-#
-# CONFIG_WAN is not set
-# CONFIG_ISDN is not set
-# CONFIG_NVM is not set
-
-#
-# Input device support
-#
-# CONFIG_INPUT is not set
-
-#
-# Hardware I/O ports
-#
-# CONFIG_SERIO is not set
-# CONFIG_GAMEPORT is not set
-
-#
-# Character devices
-#
-CONFIG_TTY=y
-# CONFIG_VT is not set
-CONFIG_UNIX98_PTYS=y
-# CONFIG_LEGACY_PTYS is not set
-# CONFIG_SERIAL_NONSTANDARD is not set
-# CONFIG_N_GSM is not set
-# CONFIG_TRACE_SINK is not set
-CONFIG_DEVMEM=y
-# CONFIG_DEVKMEM is not set
-
-#
-# Serial drivers
-#
-# CONFIG_SERIAL_8250 is not set
-
-#
-# Non-8250 serial port support
-#
-# CONFIG_SERIAL_EARLYCON_ARM_SEMIHOST is not set
-# CONFIG_SERIAL_MAX3100 is not set
-# CONFIG_SERIAL_MAX310X is not set
-# CONFIG_SERIAL_UARTLITE is not set
-CONFIG_SERIAL_CORE=y
-CONFIG_SERIAL_CORE_CONSOLE=y
-# CONFIG_SERIAL_SCCNXP is not set
-# CONFIG_SERIAL_SC16IS7XX is not set
-# CONFIG_SERIAL_BCM63XX is not set
-# CONFIG_SERIAL_ALTERA_JTAGUART is not set
-# CONFIG_SERIAL_ALTERA_UART is not set
-# CONFIG_SERIAL_IFX6X60 is not set
-# CONFIG_SERIAL_XILINX_PS_UART is not set
-# CONFIG_SERIAL_ARC is not set
-# CONFIG_SERIAL_FSL_LPUART is not set
-# CONFIG_SERIAL_CONEXANT_DIGICOLOR is not set
-# CONFIG_SERIAL_ST_ASC is not set
-# CONFIG_SERIAL_STM32 is not set
-# CONFIG_TTY_PRINTK is not set
-# CONFIG_HVC_DCC is not set
-# CONFIG_IPMI_HANDLER is not set
-# CONFIG_HW_RANDOM is not set
-# CONFIG_R3964 is not set
-# CONFIG_RAW_DRIVER is not set
-# CONFIG_TCG_TPM is not set
-# CONFIG_XILLYBUS is not set
-
-#
-# I2C support
-#
-CONFIG_I2C=y
-CONFIG_I2C_BOARDINFO=y
-# CONFIG_I2C_COMPAT is not set
-CONFIG_I2C_CHARDEV=y
-# CONFIG_I2C_MUX is not set
-# CONFIG_I2C_HELPER_AUTO is not set
-# CONFIG_I2C_SMBUS is not set
-
-#
-# I2C Algorithms
-#
-# CONFIG_I2C_ALGOBIT is not set
-# CONFIG_I2C_ALGOPCF is not set
-# CONFIG_I2C_ALGOPCA is not set
-
-#
-# I2C Hardware Bus support
-#
-
-#
-# I2C system bus drivers (mostly embedded / system-on-chip)
-#
-# CONFIG_I2C_CBUS_GPIO is not set
-# CONFIG_I2C_DESIGNWARE_PLATFORM is not set
-# CONFIG_I2C_EMEV2 is not set
-# CONFIG_I2C_GPIO is not set
-# CONFIG_I2C_OCORES is not set
-# CONFIG_I2C_PCA_PLATFORM is not set
-# CONFIG_I2C_PXA_PCI is not set
-# CONFIG_I2C_RK3X is not set
-# CONFIG_I2C_SIMTEC is not set
-# CONFIG_I2C_XILINX is not set
-
-#
-# External I2C/SMBus adapter drivers
-#
-# CONFIG_I2C_DIOLAN_U2C is not set
-# CONFIG_I2C_PARPORT_LIGHT is not set
-# CONFIG_I2C_ROBOTFUZZ_OSIF is not set
-# CONFIG_I2C_TAOS_EVM is not set
-CONFIG_I2C_TINY_USB=m
-
-#
-# Other I2C/SMBus bus drivers
-#
-# CONFIG_I2C_STUB is not set
-# CONFIG_I2C_SLAVE is not set
-# CONFIG_I2C_DEBUG_CORE is not set
-# CONFIG_I2C_DEBUG_ALGO is not set
-# CONFIG_I2C_DEBUG_BUS is not set
-CONFIG_SPI=y
-# CONFIG_SPI_DEBUG is not set
-CONFIG_SPI_MASTER=y
-
-#
-# SPI Master Controller Drivers
-#
-# CONFIG_SPI_ALTERA is not set
-# CONFIG_SPI_AXI_SPI_ENGINE is not set
-# CONFIG_SPI_BITBANG is not set
-# CONFIG_SPI_CADENCE is not set
-# CONFIG_SPI_DESIGNWARE is not set
-# CONFIG_SPI_GPIO is not set
-# CONFIG_SPI_FSL_SPI is not set
-# CONFIG_SPI_OC_TINY is not set
-# CONFIG_SPI_PXA2XX_PCI is not set
-# CONFIG_SPI_ROCKCHIP is not set
-# CONFIG_SPI_SC18IS602 is not set
-# CONFIG_SPI_XCOMM is not set
-# CONFIG_SPI_XILINX is not set
-# CONFIG_SPI_ZYNQMP_GQSPI is not set
-
-#
-# SPI Protocol Masters
-#
-# CONFIG_SPI_SPIDEV is not set
-# CONFIG_SPI_LOOPBACK_TEST is not set
-# CONFIG_SPI_TLE62X0 is not set
-# CONFIG_SPMI is not set
-# CONFIG_HSI is not set
-
-#
-# PPS support
-#
-# CONFIG_PPS is not set
-
-#
-# PPS generators support
-#
-
-#
-# PTP clock support
-#
-# CONFIG_PTP_1588_CLOCK is not set
-
-#
-# Enable PHYLIB and NETWORK_PHY_TIMESTAMPING to see the additional clocks.
-#
-CONFIG_ARCH_HAVE_CUSTOM_GPIO_H=y
-CONFIG_GPIOLIB=y
-CONFIG_OF_GPIO=y
-# CONFIG_DEBUG_GPIO is not set
-CONFIG_GPIO_SYSFS=y
-
-#
-# Memory mapped GPIO drivers
-#
-# CONFIG_GPIO_74XX_MMIO is not set
-# CONFIG_GPIO_ALTERA is not set
-# CONFIG_GPIO_DWAPB is not set
-# CONFIG_GPIO_EM is not set
-# CONFIG_GPIO_GENERIC_PLATFORM is not set
-# CONFIG_GPIO_GRGPIO is not set
-# CONFIG_GPIO_MOCKUP is not set
-# CONFIG_GPIO_MPC8XXX is not set
-# CONFIG_GPIO_XILINX is not set
-# CONFIG_GPIO_ZEVIO is not set
-# CONFIG_GPIO_ZX is not set
-
-#
-# I2C GPIO expanders
-#
-# CONFIG_GPIO_ADP5588 is not set
-# CONFIG_GPIO_ADNP is not set
-# CONFIG_GPIO_MAX7300 is not set
-# CONFIG_GPIO_MAX732X is not set
-# CONFIG_GPIO_PCA953X is not set
-# CONFIG_GPIO_PCF857X is not set
-# CONFIG_GPIO_SX150X is not set
-# CONFIG_GPIO_TPIC2810 is not set
-# CONFIG_GPIO_TS4900 is not set
-
-#
-# MFD GPIO expanders
-#
-# CONFIG_HTC_EGPIO is not set
-
-#
-# SPI GPIO expanders
-#
-# CONFIG_GPIO_74X164 is not set
-# CONFIG_GPIO_MAX7301 is not set
-# CONFIG_GPIO_MC33880 is not set
-# CONFIG_GPIO_PISOSR is not set
-
-#
-# SPI or I2C GPIO expanders
-#
-# CONFIG_GPIO_MCP23S08 is not set
-
-#
-# USB GPIO expanders
-#
-# CONFIG_W1 is not set
-# CONFIG_POWER_AVS is not set
-# CONFIG_POWER_RESET is not set
-# CONFIG_POWER_SUPPLY is not set
-# CONFIG_HWMON is not set
-# CONFIG_THERMAL is not set
-CONFIG_WATCHDOG=y
-CONFIG_WATCHDOG_CORE=y
-# CONFIG_WATCHDOG_NOWAYOUT is not set
-# CONFIG_WATCHDOG_SYSFS is not set
-
-#
-# Watchdog Device Drivers
-#
-# CONFIG_SOFT_WATCHDOG is not set
-# CONFIG_GPIO_WATCHDOG is not set
-# CONFIG_XILINX_WATCHDOG is not set
-# CONFIG_ZIIRAVE_WATCHDOG is not set
-# CONFIG_CADENCE_WATCHDOG is not set
-# CONFIG_DW_WATCHDOG is not set
-# CONFIG_MAX63XX_WATCHDOG is not set
-# CONFIG_MEN_A21_WDT is not set
-
-#
-# USB-based Watchdog Cards
-#
-# CONFIG_USBPCWATCHDOG is not set
-
-#
-# Watchdog Pretimeout Governors
-#
-# CONFIG_WATCHDOG_PRETIMEOUT_GOV is not set
-CONFIG_SSB_POSSIBLE=y
-
-#
-# Sonics Silicon Backplane
-#
-# CONFIG_SSB is not set
-CONFIG_BCMA_POSSIBLE=y
-
-#
-# Broadcom specific AMBA
-#
-# CONFIG_BCMA is not set
-
-#
-# Multifunction device drivers
-#
-# CONFIG_MFD_CORE is not set
-# CONFIG_MFD_ACT8945A is not set
-# CONFIG_MFD_AS3711 is not set
-# CONFIG_MFD_AS3722 is not set
-# CONFIG_PMIC_ADP5520 is not set
-# CONFIG_MFD_AAT2870_CORE is not set
-# CONFIG_MFD_ATMEL_FLEXCOM is not set
-# CONFIG_MFD_ATMEL_HLCDC is not set
-# CONFIG_MFD_BCM590XX is not set
-# CONFIG_MFD_AXP20X_I2C is not set
-# CONFIG_MFD_CROS_EC is not set
-# CONFIG_MFD_ASIC3 is not set
-# CONFIG_PMIC_DA903X is not set
-# CONFIG_MFD_DA9052_SPI is not set
-# CONFIG_MFD_DA9052_I2C is not set
-# CONFIG_MFD_DA9055 is not set
-# CONFIG_MFD_DA9062 is not set
-# CONFIG_MFD_DA9063 is not set
-# CONFIG_MFD_DA9150 is not set
-# CONFIG_MFD_DLN2 is not set
-# CONFIG_MFD_EXYNOS_LPASS is not set
-# CONFIG_MFD_MC13XXX_SPI is not set
-# CONFIG_MFD_MC13XXX_I2C is not set
-# CONFIG_MFD_HI6421_PMIC is not set
-# CONFIG_HTC_PASIC3 is not set
-# CONFIG_HTC_I2CPLD is not set
-# CONFIG_INTEL_SOC_PMIC is not set
-# CONFIG_MFD_KEMPLD is not set
-# CONFIG_MFD_88PM800 is not set
-# CONFIG_MFD_88PM805 is not set
-# CONFIG_MFD_88PM860X is not set
-# CONFIG_MFD_MAX14577 is not set
-# CONFIG_MFD_MAX77620 is not set
-# CONFIG_MFD_MAX77686 is not set
-# CONFIG_MFD_MAX77693 is not set
-# CONFIG_MFD_MAX77843 is not set
-# CONFIG_MFD_MAX8907 is not set
-# CONFIG_MFD_MAX8925 is not set
-# CONFIG_MFD_MAX8997 is not set
-# CONFIG_MFD_MAX8998 is not set
-# CONFIG_MFD_MT6397 is not set
-# CONFIG_MFD_MENF21BMC is not set
-# CONFIG_EZX_PCAP is not set
-# CONFIG_MFD_VIPERBOARD is not set
-# CONFIG_MFD_RETU is not set
-# CONFIG_MFD_PCF50633 is not set
-# CONFIG_MFD_PM8921_CORE is not set
-# CONFIG_MFD_RT5033 is not set
-# CONFIG_MFD_RTSX_USB is not set
-# CONFIG_MFD_RC5T583 is not set
-# CONFIG_MFD_RK808 is not set
-# CONFIG_MFD_RN5T618 is not set
-# CONFIG_MFD_SEC_CORE is not set
-# CONFIG_MFD_SI476X_CORE is not set
-# CONFIG_MFD_SM501 is not set
-# CONFIG_MFD_SKY81452 is not set
-# CONFIG_MFD_SMSC is not set
-# CONFIG_ABX500_CORE is not set
-# CONFIG_MFD_STMPE is not set
-# CONFIG_MFD_SYSCON is not set
-# CONFIG_MFD_TI_AM335X_TSCADC is not set
-# CONFIG_MFD_LP3943 is not set
-# CONFIG_MFD_LP8788 is not set
-# CONFIG_MFD_PALMAS is not set
-# CONFIG_TPS6105X is not set
-# CONFIG_TPS65010 is not set
-# CONFIG_TPS6507X is not set
-# CONFIG_MFD_TPS65086 is not set
-# CONFIG_MFD_TPS65090 is not set
-# CONFIG_MFD_TPS65217 is not set
-# CONFIG_MFD_TI_LP873X is not set
-# CONFIG_MFD_TPS65218 is not set
-# CONFIG_MFD_TPS6586X is not set
-# CONFIG_MFD_TPS65910 is not set
-# CONFIG_MFD_TPS65912_I2C is not set
-# CONFIG_MFD_TPS65912_SPI is not set
-# CONFIG_MFD_TPS80031 is not set
-# CONFIG_TWL4030_CORE is not set
-# CONFIG_TWL6040_CORE is not set
-# CONFIG_MFD_WL1273_CORE is not set
-# CONFIG_MFD_LM3533 is not set
-# CONFIG_MFD_TC3589X is not set
-# CONFIG_MFD_TMIO is not set
-# CONFIG_MFD_T7L66XB is not set
-# CONFIG_MFD_TC6387XB is not set
-# CONFIG_MFD_TC6393XB is not set
-# CONFIG_MFD_ARIZONA_I2C is not set
-# CONFIG_MFD_ARIZONA_SPI is not set
-# CONFIG_MFD_WM8400 is not set
-# CONFIG_MFD_WM831X_I2C is not set
-# CONFIG_MFD_WM831X_SPI is not set
-# CONFIG_MFD_WM8350_I2C is not set
-# CONFIG_MFD_WM8994 is not set
-# CONFIG_REGULATOR is not set
-# CONFIG_MEDIA_SUPPORT is not set
-
-#
-# Graphics support
-#
-# CONFIG_DRM is not set
-
-#
-# ACP (Audio CoProcessor) Configuration
-#
-
-#
-# Frame buffer Devices
-#
-CONFIG_FB=y
-# CONFIG_FIRMWARE_EDID is not set
-CONFIG_FB_CMDLINE=y
-CONFIG_FB_NOTIFY=y
-# CONFIG_FB_DDC is not set
-# CONFIG_FB_BOOT_VESA_SUPPORT is not set
-# CONFIG_FB_CFB_FILLRECT is not set
-# CONFIG_FB_CFB_COPYAREA is not set
-# CONFIG_FB_CFB_IMAGEBLIT is not set
-# CONFIG_FB_CFB_REV_PIXELS_IN_BYTE is not set
-# CONFIG_FB_SYS_FILLRECT is not set
-# CONFIG_FB_SYS_COPYAREA is not set
-# CONFIG_FB_SYS_IMAGEBLIT is not set
-# CONFIG_FB_FOREIGN_ENDIAN is not set
-# CONFIG_FB_SYS_FOPS is not set
-# CONFIG_FB_SVGALIB is not set
-# CONFIG_FB_MACMODES is not set
-# CONFIG_FB_BACKLIGHT is not set
-# CONFIG_FB_MODE_HELPERS is not set
-# CONFIG_FB_TILEBLITTING is not set
-
-#
-# Frame buffer hardware drivers
-#
-# CONFIG_FB_OPENCORES is not set
-# CONFIG_FB_S1D13XXX is not set
-# CONFIG_FB_SMSCUFX is not set
-# CONFIG_FB_UDL is not set
-# CONFIG_FB_IBM_GXT4500 is not set
-# CONFIG_FB_VIRTUAL is not set
-# CONFIG_FB_METRONOME is not set
-# CONFIG_FB_BROADSHEET is not set
-# CONFIG_FB_AUO_K190X is not set
-# CONFIG_FB_SIMPLE is not set
-# CONFIG_FB_SSD1307 is not set
-# CONFIG_BACKLIGHT_LCD_SUPPORT is not set
-# CONFIG_VGASTATE is not set
-# CONFIG_LOGO is not set
-# CONFIG_SOUND is not set
-CONFIG_USB_OHCI_LITTLE_ENDIAN=y
-CONFIG_USB_SUPPORT=y
-CONFIG_MP_USB_MSTAR=y
-CONFIG_USB_COMMON=y
-CONFIG_USB_ARCH_HAS_HCD=y
-CONFIG_USB=y
-CONFIG_USB_ANNOUNCE_NEW_DEVICES=y
-
-#
-# Miscellaneous USB options
-#
-CONFIG_USB_DEFAULT_PERSIST=y
-# CONFIG_USB_DYNAMIC_MINORS is not set
-# CONFIG_USB_OTG_WHITELIST is not set
-# CONFIG_USB_OTG_BLACKLIST_HUB is not set
-# CONFIG_USB_MON is not set
-# CONFIG_USB_WUSB_CBAF is not set
-
-#
-# USB Host Controller Drivers
-#
-# CONFIG_USB_C67X00_HCD is not set
-# CONFIG_USB_XHCI_HCD is not set
-CONFIG_USB_EHCI_HCD=y
-CONFIG_USB_EHCI_ROOT_HUB_TT=y
-CONFIG_USB_EHCI_TT_NEWSCHED=y
-# CONFIG_USB_EHCI_SUSPEND_PORT is not set
-# CONFIG_USB_EHCI_HCD_PLATFORM is not set
-# CONFIG_USB_OXU210HP_HCD is not set
-# CONFIG_USB_ISP116X_HCD is not set
-# CONFIG_USB_ISP1362_HCD is not set
-# CONFIG_USB_FOTG210_HCD is not set
-# CONFIG_USB_MAX3421_HCD is not set
-# CONFIG_USB_OHCI_HCD is not set
-# CONFIG_USB_SL811_HCD is not set
-# CONFIG_USB_R8A66597_HCD is not set
-# CONFIG_USB_HCD_TEST_MODE is not set
-
-#
-# USB Device Class drivers
-#
-# CONFIG_USB_ACM is not set
-# CONFIG_USB_PRINTER is not set
-# CONFIG_USB_WDM is not set
-# CONFIG_USB_TMC is not set
-
-#
-# NOTE: USB_STORAGE depends on SCSI but BLK_DEV_SD may
-#
-
-#
-# also be needed; see USB_STORAGE Help for more info
-#
-CONFIG_USB_STORAGE=m
-# CONFIG_USB_STORAGE_DEBUG is not set
-# CONFIG_USB_STORAGE_REALTEK is not set
-# CONFIG_USB_STORAGE_DATAFAB is not set
-# CONFIG_USB_STORAGE_FREECOM is not set
-# CONFIG_USB_STORAGE_ISD200 is not set
-# CONFIG_USB_STORAGE_USBAT is not set
-# CONFIG_USB_STORAGE_SDDR09 is not set
-# CONFIG_USB_STORAGE_SDDR55 is not set
-# CONFIG_USB_STORAGE_JUMPSHOT is not set
-# CONFIG_USB_STORAGE_ALAUDA is not set
-# CONFIG_USB_STORAGE_KARMA is not set
-# CONFIG_USB_STORAGE_CYPRESS_ATACB is not set
-# CONFIG_USB_STORAGE_ENE_UB6250 is not set
-# CONFIG_USB_UAS is not set
-
-#
-# USB Imaging devices
-#
-# CONFIG_USB_MDC800 is not set
-# CONFIG_USB_MICROTEK is not set
-# CONFIG_USBIP_CORE is not set
-# CONFIG_USB_MUSB_HDRC is not set
-# CONFIG_USB_DWC3 is not set
-# CONFIG_USB_DWC2 is not set
-# CONFIG_USB_CHIPIDEA is not set
-# CONFIG_USB_ISP1760 is not set
-
-#
-# USB port drivers
-#
-# CONFIG_USB_SERIAL is not set
-
-#
-# USB Miscellaneous drivers
-#
-# CONFIG_USB_EMI62 is not set
-# CONFIG_USB_EMI26 is not set
-# CONFIG_USB_ADUTUX is not set
-# CONFIG_USB_SEVSEG is not set
-# CONFIG_USB_RIO500 is not set
-# CONFIG_USB_LEGOTOWER is not set
-# CONFIG_USB_LCD is not set
-# CONFIG_USB_CYPRESS_CY7C63 is not set
-# CONFIG_USB_CYTHERM is not set
-# CONFIG_USB_IDMOUSE is not set
-# CONFIG_USB_FTDI_ELAN is not set
-# CONFIG_USB_APPLEDISPLAY is not set
-# CONFIG_USB_SISUSBVGA is not set
-# CONFIG_USB_LD is not set
-# CONFIG_USB_TRANCEVIBRATOR is not set
-# CONFIG_USB_IOWARRIOR is not set
-# CONFIG_USB_TEST is not set
-# CONFIG_USB_EHSET_TEST_FIXTURE is not set
-# CONFIG_USB_ISIGHTFW is not set
-# CONFIG_USB_YUREX is not set
-# CONFIG_USB_EZUSB_FX2 is not set
-# CONFIG_USB_HSIC_USB3503 is not set
-# CONFIG_USB_HSIC_USB4604 is not set
-# CONFIG_USB_LINK_LAYER_TEST is not set
-
-#
-# USB Physical Layer drivers
-#
-# CONFIG_USB_PHY is not set
-# CONFIG_NOP_USB_XCEIV is not set
-# CONFIG_USB_GPIO_VBUS is not set
-# CONFIG_USB_ISP1301 is not set
-# CONFIG_USB_ULPI is not set
-# CONFIG_USB_GADGET is not set
-# CONFIG_USB_ULPI_BUS is not set
-# CONFIG_UWB is not set
-CONFIG_MMC=y
-CONFIG_SS_FAST_MMC=y
-# CONFIG_MMC_DEBUG is not set
-CONFIG_PWRSEQ_EMMC=y
-CONFIG_PWRSEQ_SIMPLE=y
-
-#
-# MMC/SD/SDIO Card Drivers
-#
-CONFIG_MMC_BLOCK=y
-CONFIG_MMC_BLOCK_MINORS=8
-CONFIG_MMC_BLOCK_BOUNCE=y
-# CONFIG_SDIO_UART is not set
-# CONFIG_MMC_TEST is not set
-
-#
-# MMC/SD/SDIO Host Controller Drivers
-#
-# CONFIG_MMC_SDHCI is not set
-# CONFIG_MMC_SPI is not set
-# CONFIG_MMC_DW is not set
-# CONFIG_MMC_VUB300 is not set
-# CONFIG_MMC_USHC is not set
-# CONFIG_MMC_USDHI6ROL0 is not set
-# CONFIG_MMC_MTK is not set
-# CONFIG_MEMSTICK is not set
-# CONFIG_NEW_LEDS is not set
-# CONFIG_ACCESSIBILITY is not set
-CONFIG_EDAC_ATOMIC_SCRUB=y
-CONFIG_EDAC_SUPPORT=y
-# CONFIG_EDAC is not set
-CONFIG_RTC_LIB=y
-CONFIG_RTC_CLASS=y
-CONFIG_RTC_HCTOSYS=y
-CONFIG_RTC_HCTOSYS_DEVICE="rtc0"
-CONFIG_RTC_SYSTOHC=y
-CONFIG_RTC_SYSTOHC_DEVICE="rtc0"
-# CONFIG_RTC_DEBUG is not set
-
-#
-# RTC interfaces
-#
-CONFIG_RTC_INTF_SYSFS=y
-CONFIG_RTC_INTF_PROC=y
-CONFIG_RTC_INTF_DEV=y
-# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set
-# CONFIG_RTC_DRV_TEST is not set
-
-#
-# I2C RTC drivers
-#
-# CONFIG_RTC_DRV_ABB5ZES3 is not set
-# CONFIG_RTC_DRV_ABX80X is not set
-# CONFIG_RTC_DRV_DS1307 is not set
-# CONFIG_RTC_DRV_DS1374 is not set
-# CONFIG_RTC_DRV_DS1672 is not set
-CONFIG_RTC_DRV_HYM8563=y
-# CONFIG_RTC_DRV_MAX6900 is not set
-# CONFIG_RTC_DRV_RS5C372 is not set
-# CONFIG_RTC_DRV_ISL1208 is not set
-# CONFIG_RTC_DRV_ISL12022 is not set
-# CONFIG_RTC_DRV_X1205 is not set
-# CONFIG_RTC_DRV_PCF8523 is not set
-# CONFIG_RTC_DRV_PCF85063 is not set
-# CONFIG_RTC_DRV_PCF8563 is not set
-# CONFIG_RTC_DRV_PCF8583 is not set
-# CONFIG_RTC_DRV_M41T80 is not set
-# CONFIG_RTC_DRV_BQ32K is not set
-# CONFIG_RTC_DRV_S35390A is not set
-# CONFIG_RTC_DRV_FM3130 is not set
-# CONFIG_RTC_DRV_RX8010 is not set
-# CONFIG_RTC_DRV_RX8581 is not set
-# CONFIG_RTC_DRV_RX8025 is not set
-# CONFIG_RTC_DRV_EM3027 is not set
-# CONFIG_RTC_DRV_RV8803 is not set
-
-#
-# SPI RTC drivers
-#
-# CONFIG_RTC_DRV_M41T93 is not set
-# CONFIG_RTC_DRV_M41T94 is not set
-# CONFIG_RTC_DRV_DS1302 is not set
-# CONFIG_RTC_DRV_DS1305 is not set
-# CONFIG_RTC_DRV_DS1343 is not set
-# CONFIG_RTC_DRV_DS1347 is not set
-# CONFIG_RTC_DRV_DS1390 is not set
-# CONFIG_RTC_DRV_MAX6916 is not set
-# CONFIG_RTC_DRV_R9701 is not set
-# CONFIG_RTC_DRV_RX4581 is not set
-# CONFIG_RTC_DRV_RX6110 is not set
-# CONFIG_RTC_DRV_RS5C348 is not set
-# CONFIG_RTC_DRV_MAX6902 is not set
-# CONFIG_RTC_DRV_PCF2123 is not set
-# CONFIG_RTC_DRV_MCP795 is not set
-CONFIG_RTC_I2C_AND_SPI=y
-
-#
-# SPI and I2C RTC drivers
-#
-# CONFIG_RTC_DRV_DS3232 is not set
-# CONFIG_RTC_DRV_PCF2127 is not set
-# CONFIG_RTC_DRV_RV3029C2 is not set
-
-#
-# Platform RTC drivers
-#
-# CONFIG_RTC_DRV_CMOS is not set
-# CONFIG_RTC_DRV_DS1286 is not set
-# CONFIG_RTC_DRV_DS1511 is not set
-# CONFIG_RTC_DRV_DS1553 is not set
-# CONFIG_RTC_DRV_DS1685_FAMILY is not set
-# CONFIG_RTC_DRV_DS1742 is not set
-# CONFIG_RTC_DRV_DS2404 is not set
-# CONFIG_RTC_DRV_STK17TA8 is not set
-# CONFIG_RTC_DRV_M48T86 is not set
-# CONFIG_RTC_DRV_M48T35 is not set
-# CONFIG_RTC_DRV_M48T59 is not set
-# CONFIG_RTC_DRV_MSM6242 is not set
-# CONFIG_RTC_DRV_BQ4802 is not set
-# CONFIG_RTC_DRV_RP5C01 is not set
-# CONFIG_RTC_DRV_V3020 is not set
-# CONFIG_RTC_DRV_ZYNQMP is not set
-
-#
-# on-CPU RTC drivers
-#
-# CONFIG_RTC_DRV_SNVS is not set
-
-#
-# HID Sensor RTC drivers
-#
-# CONFIG_DMADEVICES is not set
-
-#
-# DMABUF options
-#
-# CONFIG_SYNC_FILE is not set
-# CONFIG_AUXDISPLAY is not set
-CONFIG_UIO=y
-CONFIG_UIO_PDRV_GENIRQ=y
-# CONFIG_UIO_DMEM_GENIRQ is not set
-# CONFIG_UIO_PRUSS is not set
-# CONFIG_VIRT_DRIVERS is not set
-
-#
-# Virtio drivers
-#
-# CONFIG_VIRTIO_MMIO is not set
-
-#
-# Microsoft Hyper-V guest support
-#
-CONFIG_STAGING=y
-# CONFIG_PRISM2_USB is not set
-# CONFIG_COMEDI is not set
-# CONFIG_RTLLIB is not set
-# CONFIG_R8712U is not set
-# CONFIG_R8188EU is not set
-# CONFIG_VT6656 is not set
-
-#
-# Speakup console speech
-#
-# CONFIG_STAGING_MEDIA is not set
-
-#
-# Android
-#
-# CONFIG_ASHMEM is not set
-# CONFIG_ANDROID_LOW_MEMORY_KILLER is not set
-# CONFIG_ION is not set
-# CONFIG_STAGING_BOARD is not set
-# CONFIG_LTE_GDM724X is not set
-# CONFIG_MTD_SPINAND_MT29F is not set
-# CONFIG_LNET is not set
-# CONFIG_GS_FPGABOOT is not set
-# CONFIG_COMMON_CLK_XLNX_CLKWZRD is not set
-# CONFIG_FB_TFT is not set
-# CONFIG_WILC1000_SDIO is not set
-# CONFIG_WILC1000_SPI is not set
-# CONFIG_MOST is not set
-# CONFIG_KS7010 is not set
-# CONFIG_GREYBUS is not set
-# CONFIG_GOLDFISH is not set
-# CONFIG_CHROME_PLATFORMS is not set
-CONFIG_CLKDEV_LOOKUP=y
-CONFIG_HAVE_CLK_PREPARE=y
-CONFIG_COMMON_CLK=y
-
-#
-# Common Clock Framework
-#
-# CONFIG_COMMON_CLK_SI5351 is not set
-# CONFIG_COMMON_CLK_SI514 is not set
-# CONFIG_COMMON_CLK_SI570 is not set
-# CONFIG_COMMON_CLK_CDCE706 is not set
-# CONFIG_COMMON_CLK_CDCE925 is not set
-# CONFIG_COMMON_CLK_CS2000_CP is not set
-# CONFIG_CLK_QORIQ is not set
-# CONFIG_COMMON_CLK_NXP is not set
-# CONFIG_COMMON_CLK_PWM is not set
-# CONFIG_COMMON_CLK_PXA is not set
-# CONFIG_COMMON_CLK_PIC32 is not set
-
-#
-# Hardware Spinlock drivers
-#
-
-#
-# Clock Source drivers
-#
-CONFIG_CLKSRC_OF=y
-CONFIG_CLKSRC_PROBE=y
-CONFIG_ARM_ARCH_TIMER=y
-CONFIG_ARM_ARCH_TIMER_EVTSTREAM=y
-# CONFIG_ARM_TIMER_SP804 is not set
-# CONFIG_ATMEL_PIT is not set
-# CONFIG_SH_TIMER_CMT is not set
-# CONFIG_SH_TIMER_MTU2 is not set
-# CONFIG_SH_TIMER_TMU is not set
-# CONFIG_EM_TIMER_STI is not set
-# CONFIG_MAILBOX is not set
-# CONFIG_IOMMU_SUPPORT is not set
-
-#
-# Remoteproc drivers
-#
-# CONFIG_STE_MODEM_RPROC is not set
-
-#
-# Rpmsg drivers
-#
-
-#
-# SOC (System On Chip) specific Drivers
-#
-
-#
-# Broadcom SoC drivers
-#
-# CONFIG_SOC_BRCMSTB is not set
-# CONFIG_SUNXI_SRAM is not set
-# CONFIG_SOC_TI is not set
-# CONFIG_PM_DEVFREQ is not set
-# CONFIG_EXTCON is not set
-# CONFIG_MEMORY is not set
-# CONFIG_IIO is not set
-CONFIG_PWM=y
-CONFIG_PWM_SYSFS=y
-# CONFIG_PWM_FSL_FTM is not set
-# CONFIG_PWM_PCA9685 is not set
-CONFIG_IRQCHIP=y
-CONFIG_ARM_GIC=y
-CONFIG_ARM_GIC_MAX_NR=1
-# CONFIG_IPACK_BUS is not set
-# CONFIG_RESET_CONTROLLER is not set
-# CONFIG_FMC is not set
-
-#
-# PHY Subsystem
-#
-# CONFIG_GENERIC_PHY is not set
-# CONFIG_PHY_PXA_28NM_HSIC is not set
-# CONFIG_PHY_PXA_28NM_USB2 is not set
-# CONFIG_BCM_KONA_USB2_PHY is not set
-# CONFIG_POWERCAP is not set
-# CONFIG_MCB is not set
-
-#
-# Performance monitor support
-#
-CONFIG_ARM_PMU=y
-# CONFIG_RAS is not set
-
-#
-# Android
-#
-CONFIG_ANDROID=y
-# CONFIG_ANDROID_BINDER_IPC is not set
-CONFIG_NVMEM=m
-# CONFIG_STM is not set
-# CONFIG_INTEL_TH is not set
-
-#
-# FPGA Configuration Support
-#
-# CONFIG_FPGA is not set
-CONFIG_MSTAR_DRIVERS=y
-# CONFIG_CAM_DRIVERS is not set
-# CONFIG_DLA_DRIVER is not set
-# CONFIG_MS_PIU_TIMER is not set
-CONFIG_MS_MSYS=y
-CONFIG_MS_ZEN=y
-# CONFIG_MS_MSYS_LOG is not set
-# CONFIG_MSYS_PERF_TEST is not set
-# CONFIG_MSYS_BENCH_MEMORY_FUNC is not set
-# CONFIG_MSYS_MIU_PROTECT is not set
-# CONFIG_MSYS_DMEM_SYSFS_ALL is not set
-CONFIG_MS_SERIAL=y
-# CONFIG_MS_USCLK is not set
-CONFIG_MS_FLASH_ISP=y
-CONFIG_MS_FLASH_ISP_MXP_PARTS=y
-CONFIG_MS_PWM=y
-# CONFIG_PWM_NEW is not set
-CONFIG_MS_SPINAND=m
-# CONFIG_NAND_SINGLE_READ is not set
-# CONFIG_NAND_DUAL_READ is not set
-# CONFIG_NAND_QUAL_READ is not set
-CONFIG_AUTO_DETECT=y
-# CONFIG_NAND_QUAL_WRITE is not set
-CONFIG_AUTO_DETECT_WRITE=y
-CONFIG_MS_SPI_INFINITY=y
-# CONFIG_SS_MSPI is not set
-# CONFIG_CAM_CLK is not set
-# CONFIG_MS_EMMC is not set
-CONFIG_MS_SDMMC=y
-CONFIG_MS_EMAC=y
-# CONFIG_EMAC_SUPPLY_RNG is not set
-# CONFIG_MSTAR_HW_TX_CHECKSUM is not set
-# CONFIG_K3_RX_SWPATCH is not set
-CONFIG_DISCONNECT_DELAY_S=1
-# CONFIG_MSTAR_EEE is not set
-# CONFIG_EMAC_PHY_RESTART_AN is not set
-# CONFIG_MS_IRCUT is not set
-CONFIG_MS_RTC=y
-CONFIG_RTC_INNER=y
-# CONFIG_RTCPWC_INNER is not set
-CONFIG_MS_CRYPTO=y
-# CONFIG_SS_AESDMA_INTR is not set
-# CONFIG_SS_RNG is not set
-CONFIG_CRYPTODEV=m
-CONFIG_MS_CPU_FREQ=y
-CONFIG_MS_IVE=y
-CONFIG_MS_NOTIFY=m
-CONFIG_SS_ISP_ISRCB=y
-CONFIG_MSTAR_MIU=y
-CONFIG_SSC007A_S01A=y
-CONFIG_MS_BDMA=y
-# CONFIG_MS_BDMA_LINE_OFFSET_ON is not set
-CONFIG_MS_MOVE_DMA=y
-# CONFIG_MS_IR is not set
-CONFIG_MS_I2C=y
-# CONFIG_MS_I2C_INT_ISR is not set
-CONFIG_MS_GPIO=y
-CONFIG_MS_SW_I2C=y
-CONFIG_MS_PADMUX=y
-CONFIG_MS_WATCHDOG=y
-CONFIG_MS_SAR=y
-# CONFIG_MS_SARKEY is not set
-CONFIG_MSTAR_MMAHEAP=y
-CONFIG_SSTAR_NETPHY=y
-CONFIG_SS_VOLTAGE_CTRL=y
-# CONFIG_SS_SWTOE is not set
-# CONFIG_MS_EMAC_TOE is not set
-
-#
-# Firmware Drivers
-#
-# CONFIG_FIRMWARE_MEMMAP is not set
-# CONFIG_FW_CFG_SYSFS is not set
-CONFIG_HAVE_ARM_SMCCC=y
-
-#
-# File systems
-#
-CONFIG_DCACHE_WORD_ACCESS=y
-# CONFIG_EXT2_FS is not set
-# CONFIG_EXT3_FS is not set
-# CONFIG_EXT4_FS is not set
-# CONFIG_REISERFS_FS is not set
-# CONFIG_JFS_FS is not set
-# CONFIG_OCFS2_FS is not set
-# CONFIG_BTRFS_FS is not set
-# CONFIG_NILFS2_FS is not set
-CONFIG_F2FS_FS=m
-CONFIG_F2FS_STAT_FS=y
-CONFIG_F2FS_FS_XATTR=y
-CONFIG_F2FS_FS_POSIX_ACL=y
-# CONFIG_F2FS_FS_SECURITY is not set
-# CONFIG_F2FS_CHECK_FS is not set
-# CONFIG_F2FS_FS_ENCRYPTION is not set
-# CONFIG_F2FS_FAULT_INJECTION is not set
-CONFIG_FS_POSIX_ACL=y
-# CONFIG_EXPORTFS_BLOCK_OPS is not set
-CONFIG_FILE_LOCKING=y
-CONFIG_MANDATORY_FILE_LOCKING=y
-# CONFIG_FS_ENCRYPTION is not set
-CONFIG_FSNOTIFY=y
-CONFIG_DNOTIFY=y
-CONFIG_INOTIFY_USER=y
-# CONFIG_FANOTIFY is not set
-# CONFIG_QUOTA is not set
-# CONFIG_QUOTACTL is not set
-# CONFIG_AUTOFS4_FS is not set
-# CONFIG_FUSE_FS is not set
-CONFIG_OVERLAY_FS=y
-
-#
-# Caches
-#
-# CONFIG_FSCACHE is not set
-
-#
-# CD-ROM/DVD Filesystems
-#
-# CONFIG_ISO9660_FS is not set
-# CONFIG_UDF_FS is not set
-
-#
-# DOS/FAT/NT Filesystems
-#
-CONFIG_FAT_FS=m
-# CONFIG_MSDOS_FS is not set
-CONFIG_VFAT_FS=m
-CONFIG_FAT_DEFAULT_CODEPAGE=437
-CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1"
-# CONFIG_FAT_DEFAULT_UTF8 is not set
-# CONFIG_NTFS_FS is not set
-
-#
-# Pseudo filesystems
-#
-CONFIG_PROC_FS=y
-CONFIG_PROC_SYSCTL=y
-CONFIG_PROC_PAGE_MONITOR=y
-# CONFIG_PROC_CHILDREN is not set
-CONFIG_KERNFS=y
-CONFIG_SYSFS=y
-CONFIG_TMPFS=y
-CONFIG_TMPFS_POSIX_ACL=y
-CONFIG_TMPFS_XATTR=y
-# CONFIG_HUGETLB_PAGE is not set
-CONFIG_CONFIGFS_FS=y
-CONFIG_MISC_FILESYSTEMS=y
-# CONFIG_ORANGEFS_FS is not set
-# CONFIG_ADFS_FS is not set
-# CONFIG_AFFS_FS is not set
-# CONFIG_HFS_FS is not set
-# CONFIG_HFSPLUS_FS is not set
-# CONFIG_BEFS_FS is not set
-# CONFIG_BFS_FS is not set
-# CONFIG_EFS_FS is not set
-CONFIG_JFFS2_FS=y
-CONFIG_JFFS2_FS_DEBUG=0
-# CONFIG_JFFS2_FS_WRITEBUFFER is not set
-# CONFIG_JFFS2_SUMMARY is not set
-# CONFIG_JFFS2_FS_XATTR is not set
-# CONFIG_JFFS2_COMPRESSION_OPTIONS is not set
-CONFIG_JFFS2_ZLIB=y
-# CONFIG_JFFS2_LZO is not set
-CONFIG_JFFS2_RTIME=y
-# CONFIG_JFFS2_RUBIN is not set
-# CONFIG_UBIFS_FS is not set
-# CONFIG_LOGFS is not set
-# CONFIG_CRAMFS is not set
-CONFIG_SQUASHFS=y
-# CONFIG_SQUASHFS_FILE_CACHE is not set
-CONFIG_SQUASHFS_FILE_DIRECT=y
-CONFIG_SQUASHFS_DECOMP_SINGLE=y
-# CONFIG_SQUASHFS_DECOMP_MULTI is not set
-# CONFIG_SQUASHFS_DECOMP_MULTI_PERCPU is not set
-# CONFIG_SQUASHFS_XATTR is not set
-CONFIG_SQUASHFS_ZLIB=y
-# CONFIG_SQUASHFS_LZ4 is not set
-CONFIG_SQUASHFS_LZO=y
-CONFIG_SQUASHFS_XZ=y
-CONFIG_SQUASHFS_4K_DEVBLK_SIZE=y
-CONFIG_SQUASHFS_EMBEDDED=y
-CONFIG_SQUASHFS_FRAGMENT_CACHE_SIZE=3
-# CONFIG_VXFS_FS is not set
-# CONFIG_MINIX_FS is not set
-# CONFIG_OMFS_FS is not set
-# CONFIG_HPFS_FS is not set
-# CONFIG_QNX4FS_FS is not set
-# CONFIG_QNX6FS_FS is not set
-# CONFIG_ROMFS_FS is not set
-# CONFIG_PSTORE is not set
-# CONFIG_SYSV_FS is not set
-# CONFIG_UFS_FS is not set
-CONFIG_NETWORK_FILESYSTEMS=y
-CONFIG_NFS_FS=y
-# CONFIG_NFS_V2 is not set
-CONFIG_NFS_V3=y
-CONFIG_NFS_V3_ACL=y
-# CONFIG_NFS_V4 is not set
-# CONFIG_NFS_SWAP is not set
-CONFIG_ROOT_NFS=y
-# CONFIG_NFSD is not set
-CONFIG_GRACE_PERIOD=y
-CONFIG_LOCKD=y
-CONFIG_LOCKD_V4=y
-CONFIG_NFS_ACL_SUPPORT=y
-CONFIG_NFS_COMMON=y
-CONFIG_SUNRPC=y
-# CONFIG_SUNRPC_DEBUG is not set
-# CONFIG_CEPH_FS is not set
-# CONFIG_CIFS is not set
-# CONFIG_CIFS_STATS is not set
-# CONFIG_CIFS_WEAK_PW_HASH is not set
-# CONFIG_CIFS_XATTR is not set
-# CONFIG_CIFS_DEBUG is not set
-# CONFIG_CIFS_SMB2 is not set
-# CONFIG_NCP_FS is not set
-# CONFIG_CODA_FS is not set
-# CONFIG_AFS_FS is not set
-CONFIG_NLS=y
-CONFIG_NLS_DEFAULT="iso8859-1"
-CONFIG_NLS_CODEPAGE_437=y
-# CONFIG_NLS_CODEPAGE_737 is not set
-# CONFIG_NLS_CODEPAGE_775 is not set
-# CONFIG_NLS_CODEPAGE_850 is not set
-# CONFIG_NLS_CODEPAGE_852 is not set
-# CONFIG_NLS_CODEPAGE_855 is not set
-# CONFIG_NLS_CODEPAGE_857 is not set
-# CONFIG_NLS_CODEPAGE_860 is not set
-# CONFIG_NLS_CODEPAGE_861 is not set
-# CONFIG_NLS_CODEPAGE_862 is not set
-# CONFIG_NLS_CODEPAGE_863 is not set
-# CONFIG_NLS_CODEPAGE_864 is not set
-# CONFIG_NLS_CODEPAGE_865 is not set
-# CONFIG_NLS_CODEPAGE_866 is not set
-# CONFIG_NLS_CODEPAGE_869 is not set
-# CONFIG_NLS_CODEPAGE_936 is not set
-# CONFIG_NLS_CODEPAGE_950 is not set
-# CONFIG_NLS_CODEPAGE_932 is not set
-# CONFIG_NLS_CODEPAGE_949 is not set
-# CONFIG_NLS_CODEPAGE_874 is not set
-# CONFIG_NLS_ISO8859_8 is not set
-# CONFIG_NLS_CODEPAGE_1250 is not set
-# CONFIG_NLS_CODEPAGE_1251 is not set
-# CONFIG_NLS_ASCII is not set
-CONFIG_NLS_ISO8859_1=y
-# CONFIG_NLS_ISO8859_2 is not set
-# CONFIG_NLS_ISO8859_3 is not set
-# CONFIG_NLS_ISO8859_4 is not set
-# CONFIG_NLS_ISO8859_5 is not set
-# CONFIG_NLS_ISO8859_6 is not set
-# CONFIG_NLS_ISO8859_7 is not set
-# CONFIG_NLS_ISO8859_9 is not set
-# CONFIG_NLS_ISO8859_13 is not set
-# CONFIG_NLS_ISO8859_14 is not set
-# CONFIG_NLS_ISO8859_15 is not set
-# CONFIG_NLS_KOI8_R is not set
-# CONFIG_NLS_KOI8_U is not set
-# CONFIG_NLS_MAC_ROMAN is not set
-# CONFIG_NLS_MAC_CELTIC is not set
-# CONFIG_NLS_MAC_CENTEURO is not set
-# CONFIG_NLS_MAC_CROATIAN is not set
-# CONFIG_NLS_MAC_CYRILLIC is not set
-# CONFIG_NLS_MAC_GAELIC is not set
-# CONFIG_NLS_MAC_GREEK is not set
-# CONFIG_NLS_MAC_ICELAND is not set
-# CONFIG_NLS_MAC_INUIT is not set
-# CONFIG_NLS_MAC_ROMANIAN is not set
-# CONFIG_NLS_MAC_TURKISH is not set
-CONFIG_NLS_UTF8=y
-# CONFIG_DLM is not set
-
-#
-# Kernel hacking
-#
-
-#
-# printk and dmesg options
-#
-# CONFIG_PRINTK_TIME is not set
-CONFIG_MESSAGE_LOGLEVEL_DEFAULT=3
-# CONFIG_BOOT_PRINTK_DELAY is not set
-# CONFIG_DYNAMIC_DEBUG is not set
-
-#
-# Compile-time checks and compiler options
-#
-CONFIG_DEBUG_INFO=y
-# CONFIG_DEBUG_INFO_REDUCED is not set
-# CONFIG_DEBUG_INFO_SPLIT is not set
-# CONFIG_DEBUG_INFO_DWARF4 is not set
-# CONFIG_GDB_SCRIPTS is not set
-CONFIG_ENABLE_WARN_DEPRECATED=y
-CONFIG_ENABLE_MUST_CHECK=y
-CONFIG_FRAME_WARN=4096
-# CONFIG_STRIP_ASM_SYMS is not set
-# CONFIG_READABLE_ASM is not set
-# CONFIG_UNUSED_SYMBOLS is not set
-# CONFIG_PAGE_OWNER is not set
-CONFIG_DEBUG_FS=y
-# CONFIG_HEADERS_CHECK is not set
-# CONFIG_DEBUG_SECTION_MISMATCH is not set
-CONFIG_SECTION_MISMATCH_WARN_ONLY=y
-# CONFIG_DEBUG_FORCE_WEAK_PER_CPU is not set
-CONFIG_MAGIC_SYSRQ=y
-CONFIG_DEBUG_KERNEL=y
-
-#
-# Memory Debugging
-#
-# CONFIG_PAGE_EXTENSION is not set
-# CONFIG_DEBUG_PAGEALLOC is not set
-# CONFIG_PAGE_POISONING is not set
-# CONFIG_DEBUG_OBJECTS is not set
-# CONFIG_SLUB_STATS is not set
-CONFIG_HAVE_DEBUG_KMEMLEAK=y
-# CONFIG_DEBUG_KMEMLEAK is not set
-# CONFIG_DEBUG_STACK_USAGE is not set
-# CONFIG_DEBUG_VM is not set
-# CONFIG_DEBUG_MEMORY_INIT is not set
-# CONFIG_DEBUG_SHIRQ is not set
-
-#
-# Debug Lockups and Hangs
-#
-CONFIG_LOCKUP_DETECTOR=y
-# CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC is not set
-CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC_VALUE=0
-# CONFIG_DETECT_HUNG_TASK is not set
-# CONFIG_WQ_WATCHDOG is not set
-# CONFIG_PANIC_ON_OOPS is not set
-CONFIG_PANIC_ON_OOPS_VALUE=0
-CONFIG_PANIC_TIMEOUT=0
-# CONFIG_SCHED_DEBUG is not set
-# CONFIG_SCHED_INFO is not set
-# CONFIG_SCHEDSTATS is not set
-# CONFIG_SCHED_STACK_END_CHECK is not set
-# CONFIG_DEBUG_TIMEKEEPING is not set
-# CONFIG_TIMER_STATS is not set
-# CONFIG_DEBUG_PREEMPT is not set
-
-#
-# Lock Debugging (spinlocks, mutexes, etc...)
-#
-CONFIG_DEBUG_RT_MUTEXES=y
-CONFIG_DEBUG_SPINLOCK=y
-CONFIG_DEBUG_MUTEXES=y
-# CONFIG_DEBUG_WW_MUTEX_SLOWPATH is not set
-# CONFIG_DEBUG_LOCK_ALLOC is not set
-# CONFIG_PROVE_LOCKING is not set
-# CONFIG_LOCK_STAT is not set
-# CONFIG_DEBUG_ATOMIC_SLEEP is not set
-# CONFIG_DEBUG_LOCKING_API_SELFTESTS is not set
-# CONFIG_LOCK_TORTURE_TEST is not set
-CONFIG_STACKTRACE=y
-# CONFIG_DEBUG_KOBJECT is not set
-# CONFIG_DEBUG_BUGVERBOSE is not set
-# CONFIG_DEBUG_LIST is not set
-# CONFIG_DEBUG_PI_LIST is not set
-# CONFIG_DEBUG_SG is not set
-# CONFIG_DEBUG_NOTIFIERS is not set
-# CONFIG_DEBUG_CREDENTIALS is not set
-
-#
-# RCU Debugging
-#
-# CONFIG_PROVE_RCU is not set
-# CONFIG_SPARSE_RCU_POINTER is not set
-# CONFIG_TORTURE_TEST is not set
-# CONFIG_RCU_PERF_TEST is not set
-# CONFIG_RCU_TORTURE_TEST is not set
-CONFIG_RCU_CPU_STALL_TIMEOUT=21
-# CONFIG_RCU_TRACE is not set
-# CONFIG_RCU_EQS_DEBUG is not set
-# CONFIG_DEBUG_WQ_FORCE_RR_CPU is not set
-# CONFIG_DEBUG_BLOCK_EXT_DEVT is not set
-# CONFIG_NOTIFIER_ERROR_INJECTION is not set
-# CONFIG_FAULT_INJECTION is not set
-# CONFIG_LATENCYTOP is not set
-CONFIG_HAVE_FUNCTION_TRACER=y
-CONFIG_HAVE_DYNAMIC_FTRACE=y
-CONFIG_HAVE_FTRACE_MCOUNT_RECORD=y
-CONFIG_HAVE_SYSCALL_TRACEPOINTS=y
-CONFIG_HAVE_C_RECORDMCOUNT=y
-CONFIG_TRACING_SUPPORT=y
-# CONFIG_FTRACE is not set
-
-#
-# Runtime Testing
-#
-# CONFIG_LKDTM is not set
-# CONFIG_TEST_LIST_SORT is not set
-# CONFIG_BACKTRACE_SELF_TEST is not set
-# CONFIG_RBTREE_TEST is not set
-# CONFIG_INTERVAL_TREE_TEST is not set
-# CONFIG_PERCPU_TEST is not set
-# CONFIG_ATOMIC64_SELFTEST is not set
-# CONFIG_TEST_HEXDUMP is not set
-# CONFIG_TEST_STRING_HELPERS is not set
-# CONFIG_TEST_KSTRTOX is not set
-# CONFIG_TEST_PRINTF is not set
-# CONFIG_TEST_BITMAP is not set
-# CONFIG_TEST_UUID is not set
-# CONFIG_TEST_RHASHTABLE is not set
-# CONFIG_TEST_HASH is not set
-# CONFIG_DMA_API_DEBUG is not set
-# CONFIG_TEST_LKM is not set
-# CONFIG_TEST_USER_COPY is not set
-# CONFIG_TEST_BPF is not set
-# CONFIG_TEST_UDELAY is not set
-# CONFIG_MEMTEST is not set
-# CONFIG_TEST_STATIC_KEYS is not set
-# CONFIG_SAMPLES is not set
-CONFIG_HAVE_ARCH_KGDB=y
-# CONFIG_KGDB is not set
-# CONFIG_ARCH_WANTS_UBSAN_NO_NULL is not set
-# CONFIG_UBSAN is not set
-CONFIG_ARCH_HAS_DEVMEM_IS_ALLOWED=y
-# CONFIG_STRICT_DEVMEM is not set
-# CONFIG_ARM_PTDUMP is not set
-CONFIG_ARM_UNWIND=y
-# CONFIG_DEBUG_USER is not set
-# CONFIG_DEBUG_LL is not set
-CONFIG_DEBUG_LL_INCLUDE="mach/debug-macro.S"
-# CONFIG_DEBUG_UART_8250 is not set
-CONFIG_UNCOMPRESS_INCLUDE="debug/uncompress.h"
-# CONFIG_PID_IN_CONTEXTIDR is not set
-# CONFIG_DEBUG_SET_MODULE_RONX is not set
-# CONFIG_CORESIGHT is not set
-
-#
-# Security options
-#
-# CONFIG_KEYS is not set
-# CONFIG_SECURITY_DMESG_RESTRICT is not set
-# CONFIG_SECURITY is not set
-# CONFIG_SECURITYFS is not set
-CONFIG_HAVE_HARDENED_USERCOPY_ALLOCATOR=y
-CONFIG_HAVE_ARCH_HARDENED_USERCOPY=y
-# CONFIG_HARDENED_USERCOPY is not set
-CONFIG_DEFAULT_SECURITY_DAC=y
-CONFIG_DEFAULT_SECURITY=""
-CONFIG_CRYPTO=y
-
-#
-# Crypto core or helper
-#
-CONFIG_CRYPTO_ALGAPI=y
-CONFIG_CRYPTO_ALGAPI2=y
-CONFIG_CRYPTO_AEAD=y
-CONFIG_CRYPTO_AEAD2=y
-CONFIG_CRYPTO_BLKCIPHER=y
-CONFIG_CRYPTO_BLKCIPHER2=y
-CONFIG_CRYPTO_HASH=y
-CONFIG_CRYPTO_HASH2=y
-CONFIG_CRYPTO_RNG=y
-CONFIG_CRYPTO_RNG2=y
-CONFIG_CRYPTO_RNG_DEFAULT=y
-CONFIG_CRYPTO_AKCIPHER2=y
-CONFIG_CRYPTO_KPP2=y
-# CONFIG_CRYPTO_RSA is not set
-# CONFIG_CRYPTO_DH is not set
-# CONFIG_CRYPTO_ECDH is not set
-CONFIG_CRYPTO_MANAGER=y
-CONFIG_CRYPTO_MANAGER2=y
-# CONFIG_CRYPTO_USER is not set
-CONFIG_CRYPTO_MANAGER_DISABLE_TESTS=y
-CONFIG_CRYPTO_GF128MUL=m
-CONFIG_CRYPTO_NULL=y
-CONFIG_CRYPTO_NULL2=y
-CONFIG_CRYPTO_WORKQUEUE=y
-# CONFIG_CRYPTO_CRYPTD is not set
-# CONFIG_CRYPTO_MCRYPTD is not set
-# CONFIG_CRYPTO_AUTHENC is not set
-# CONFIG_CRYPTO_TEST is not set
-
-#
-# Authenticated Encryption with Associated Data
-#
-CONFIG_CRYPTO_CCM=m
-CONFIG_CRYPTO_GCM=m
-# CONFIG_CRYPTO_CHACHA20POLY1305 is not set
-CONFIG_CRYPTO_SEQIV=y
-CONFIG_CRYPTO_ECHAINIV=m
-
-#
-# Block modes
-#
-CONFIG_CRYPTO_CBC=y
-CONFIG_CRYPTO_CTR=y
-# CONFIG_CRYPTO_CTS is not set
-CONFIG_CRYPTO_ECB=y
-# CONFIG_CRYPTO_LRW is not set
-# CONFIG_CRYPTO_PCBC is not set
-# CONFIG_CRYPTO_XTS is not set
-# CONFIG_CRYPTO_KEYWRAP is not set
-
-#
-# Hash modes
-#
-CONFIG_CRYPTO_CMAC=y
-CONFIG_CRYPTO_HMAC=y
-# CONFIG_CRYPTO_XCBC is not set
-# CONFIG_CRYPTO_VMAC is not set
-
-#
-# Digest
-#
-# CONFIG_CRYPTO_CRC32C is not set
-CONFIG_CRYPTO_CRC32=y
-# CONFIG_CRYPTO_CRCT10DIF is not set
-CONFIG_CRYPTO_GHASH=m
-# CONFIG_CRYPTO_POLY1305 is not set
-CONFIG_CRYPTO_MD4=y
-CONFIG_CRYPTO_MD5=y
-# CONFIG_CRYPTO_MICHAEL_MIC is not set
-# CONFIG_CRYPTO_RMD128 is not set
-# CONFIG_CRYPTO_RMD160 is not set
-# CONFIG_CRYPTO_RMD256 is not set
-# CONFIG_CRYPTO_RMD320 is not set
-# CONFIG_CRYPTO_SHA1 is not set
-CONFIG_CRYPTO_SHA256=y
-# CONFIG_CRYPTO_SHA512 is not set
-# CONFIG_CRYPTO_SHA3 is not set
-# CONFIG_CRYPTO_TGR192 is not set
-# CONFIG_CRYPTO_WP512 is not set
-
-#
-# Ciphers
-#
-CONFIG_CRYPTO_AES=y
-# CONFIG_CRYPTO_ANUBIS is not set
-CONFIG_CRYPTO_ARC4=y
-# CONFIG_CRYPTO_BLOWFISH is not set
-# CONFIG_CRYPTO_CAMELLIA is not set
-# CONFIG_CRYPTO_CAST5 is not set
-# CONFIG_CRYPTO_CAST6 is not set
-CONFIG_CRYPTO_DES=y
-# CONFIG_CRYPTO_FCRYPT is not set
-# CONFIG_CRYPTO_KHAZAD is not set
-# CONFIG_CRYPTO_SALSA20 is not set
-# CONFIG_CRYPTO_CHACHA20 is not set
-# CONFIG_CRYPTO_SEED is not set
-# CONFIG_CRYPTO_SERPENT is not set
-# CONFIG_CRYPTO_TEA is not set
-# CONFIG_CRYPTO_TWOFISH is not set
-
-#
-# Compression
-#
-CONFIG_CRYPTO_DEFLATE=y
-CONFIG_CRYPTO_LZO=y
-# CONFIG_CRYPTO_842 is not set
-# CONFIG_CRYPTO_LZ4 is not set
-# CONFIG_CRYPTO_LZ4HC is not set
-
-#
-# Random Number Generation
-#
-# CONFIG_CRYPTO_ANSI_CPRNG is not set
-CONFIG_CRYPTO_DRBG_MENU=y
-CONFIG_CRYPTO_DRBG_HMAC=y
-# CONFIG_CRYPTO_DRBG_HASH is not set
-# CONFIG_CRYPTO_DRBG_CTR is not set
-CONFIG_CRYPTO_DRBG=y
-CONFIG_CRYPTO_JITTERENTROPY=y
-# CONFIG_CRYPTO_USER_API_HASH is not set
-# CONFIG_CRYPTO_USER_API_SKCIPHER is not set
-# CONFIG_CRYPTO_USER_API_RNG is not set
-# CONFIG_CRYPTO_USER_API_AEAD is not set
-# CONFIG_CRYPTO_HW is not set
-
-#
-# Certificates for signature checking
-#
-# CONFIG_ARM_CRYPTO is not set
-# CONFIG_BINARY_PRINTF is not set
-
-#
-# Library routines
-#
-CONFIG_BITREVERSE=y
-CONFIG_HAVE_ARCH_BITREVERSE=y
-CONFIG_RATIONAL=y
-CONFIG_GENERIC_STRNCPY_FROM_USER=y
-CONFIG_GENERIC_STRNLEN_USER=y
-CONFIG_GENERIC_NET_UTILS=y
-CONFIG_GENERIC_PCI_IOMAP=y
-CONFIG_GENERIC_IO=y
-CONFIG_ARCH_USE_CMPXCHG_LOCKREF=y
-# CONFIG_CRC_CCITT is not set
-CONFIG_CRC16=y
-# CONFIG_CRC_T10DIF is not set
-# CONFIG_CRC_ITU_T is not set
-CONFIG_CRC32=y
-# CONFIG_CRC32_SELFTEST is not set
-CONFIG_CRC32_SLICEBY8=y
-# CONFIG_CRC32_SLICEBY4 is not set
-# CONFIG_CRC32_SARWATE is not set
-# CONFIG_CRC32_BIT is not set
-# CONFIG_CRC7 is not set
-# CONFIG_LIBCRC32C is not set
-# CONFIG_CRC8 is not set
-# CONFIG_AUDIT_ARCH_COMPAT_GENERIC is not set
-# CONFIG_RANDOM32_SELFTEST is not set
-CONFIG_ZLIB_INFLATE=y
-CONFIG_ZLIB_DEFLATE=y
-CONFIG_LZO_COMPRESS=y
-CONFIG_LZO_DECOMPRESS=y
-CONFIG_XZ_DEC=y
-# CONFIG_XZ_DEC_X86 is not set
-# CONFIG_XZ_DEC_POWERPC is not set
-# CONFIG_XZ_DEC_IA64 is not set
-CONFIG_XZ_DEC_ARM=y
-CONFIG_XZ_DEC_ARMTHUMB=y
-# CONFIG_XZ_DEC_SPARC is not set
-CONFIG_XZ_DEC_BCJ=y
-# CONFIG_XZ_DEC_TEST is not set
-CONFIG_GENERIC_ALLOCATOR=y
-CONFIG_HAS_IOMEM=y
-CONFIG_HAS_IOPORT_MAP=y
-CONFIG_HAS_DMA=y
-CONFIG_DQL=y
-CONFIG_NLATTR=y
-# CONFIG_CORDIC is not set
-# CONFIG_DDR is not set
-# CONFIG_IRQ_POLL is not set
-CONFIG_LIBFDT=y
-# CONFIG_SG_SPLIT is not set
-CONFIG_SG_POOL=y
-CONFIG_ARCH_HAS_SG_CHAIN=y
-CONFIG_SBITMAP=y
-# CONFIG_VIRTUALIZATION is not set
diff --git a/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335de.generic.config.kama b/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335de.generic.config.kama
deleted file mode 100644
index d494a0b6..00000000
--- a/br-ext-chip-sigmastar/board/infinity6b0/kernel/ssc335de.generic.config.kama
+++ /dev/null
@@ -1,2654 +0,0 @@
-#
-# Automatically generated file; DO NOT EDIT.
-# Linux/arm 4.9.84 Kernel Configuration
-#
-CONFIG_ARM=y
-CONFIG_ARM_HAS_SG_CHAIN=y
-CONFIG_MIGHT_HAVE_PCI=y
-CONFIG_SYS_SUPPORTS_APM_EMULATION=y
-CONFIG_HAVE_PROC_CPU=y
-CONFIG_STACKTRACE_SUPPORT=y
-CONFIG_LOCKDEP_SUPPORT=y
-CONFIG_TRACE_IRQFLAGS_SUPPORT=y
-CONFIG_RWSEM_XCHGADD_ALGORITHM=y
-CONFIG_FIX_EARLYCON_MEM=y
-CONFIG_GENERIC_HWEIGHT=y
-CONFIG_GENERIC_CALIBRATE_DELAY=y
-CONFIG_NEED_DMA_MAP_STATE=y
-CONFIG_ARCH_SUPPORTS_UPROBES=y
-CONFIG_VECTORS_BASE=0xffff0000
-CONFIG_ARM_PATCH_PHYS_VIRT=y
-CONFIG_GENERIC_BUG=y
-CONFIG_PGTABLE_LEVELS=2
-CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config"
-CONFIG_IRQ_WORK=y
-CONFIG_BUILDTIME_EXTABLE_SORT=y
-
-#
-# General setup
-#
-CONFIG_BROKEN_ON_SMP=y
-CONFIG_INIT_ENV_ARG_LIMIT=32
-CONFIG_CROSS_COMPILE=""
-# CONFIG_COMPILE_TEST is not set
-CONFIG_LOCALVERSION=""
-# CONFIG_LOCALVERSION_AUTO is not set
-CONFIG_HAVE_KERNEL_GZIP=y
-CONFIG_HAVE_KERNEL_LZMA=y
-CONFIG_HAVE_KERNEL_XZ=y
-CONFIG_HAVE_KERNEL_LZO=y
-CONFIG_HAVE_KERNEL_LZ4=y
-# CONFIG_KERNEL_GZIP is not set
-# CONFIG_KERNEL_LZMA is not set
-CONFIG_KERNEL_XZ=y
-# CONFIG_KERNEL_LZO is not set
-# CONFIG_KERNEL_LZ4 is not set
-CONFIG_DEFAULT_HOSTNAME="ipcam"
-# CONFIG_SWAP is not set
-CONFIG_SYSVIPC=y
-CONFIG_SYSVIPC_SYSCTL=y
-CONFIG_POSIX_MQUEUE=y
-CONFIG_POSIX_MQUEUE_SYSCTL=y
-# CONFIG_CROSS_MEMORY_ATTACH is not set
-# CONFIG_FHANDLE is not set
-# CONFIG_USELIB is not set
-# CONFIG_AUDIT is not set
-CONFIG_HAVE_ARCH_AUDITSYSCALL=y
-
-#
-# IRQ subsystem
-#
-CONFIG_GENERIC_IRQ_PROBE=y
-CONFIG_GENERIC_IRQ_SHOW=y
-CONFIG_GENERIC_IRQ_SHOW_LEVEL=y
-CONFIG_HARDIRQS_SW_RESEND=y
-CONFIG_IRQ_DOMAIN=y
-CONFIG_IRQ_DOMAIN_HIERARCHY=y
-CONFIG_HANDLE_DOMAIN_IRQ=y
-# CONFIG_IRQ_DOMAIN_DEBUG is not set
-CONFIG_IRQ_FORCED_THREADING=y
-CONFIG_SPARSE_IRQ=y
-CONFIG_ARCH_CLOCKSOURCE_DATA=y
-CONFIG_GENERIC_TIME_VSYSCALL=y
-CONFIG_GENERIC_CLOCKEVENTS=y
-
-#
-# Timers subsystem
-#
-CONFIG_TICK_ONESHOT=y
-CONFIG_NO_HZ_COMMON=y
-# CONFIG_HZ_PERIODIC is not set
-CONFIG_NO_HZ_IDLE=y
-CONFIG_NO_HZ=y
-CONFIG_HIGH_RES_TIMERS=y
-
-#
-# CPU/Task time and stats accounting
-#
-CONFIG_TICK_CPU_ACCOUNTING=y
-# CONFIG_VIRT_CPU_ACCOUNTING_GEN is not set
-# CONFIG_IRQ_TIME_ACCOUNTING is not set
-# CONFIG_BSD_PROCESS_ACCT is not set
-# CONFIG_TASKSTATS is not set
-
-#
-# RCU Subsystem
-#
-CONFIG_PREEMPT_RCU=y
-# CONFIG_RCU_EXPERT is not set
-CONFIG_SRCU=y
-# CONFIG_TASKS_RCU is not set
-CONFIG_RCU_STALL_COMMON=y
-# CONFIG_TREE_RCU_TRACE is not set
-# CONFIG_RCU_EXPEDITE_BOOT is not set
-# CONFIG_BUILD_BIN2C is not set
-# CONFIG_IKCONFIG is not set
-CONFIG_LOG_BUF_SHIFT=15
-CONFIG_NMI_LOG_BUF_SHIFT=13
-CONFIG_GENERIC_SCHED_CLOCK=y
-CONFIG_CGROUPS=y
-# CONFIG_MEMCG is not set
-# CONFIG_BLK_CGROUP is not set
-# CONFIG_CGROUP_SCHED is not set
-# CONFIG_CGROUP_PIDS is not set
-# CONFIG_CGROUP_FREEZER is not set
-# CONFIG_CPUSETS is not set
-# CONFIG_CGROUP_DEVICE is not set
-# CONFIG_CGROUP_CPUACCT is not set
-# CONFIG_CGROUP_PERF is not set
-# CONFIG_CGROUP_DEBUG is not set
-# CONFIG_CHECKPOINT_RESTORE is not set
-CONFIG_NAMESPACES=y
-CONFIG_UTS_NS=y
-CONFIG_IPC_NS=y
-# CONFIG_USER_NS is not set
-CONFIG_PID_NS=y
-CONFIG_NET_NS=y
-# CONFIG_SCHED_AUTOGROUP is not set
-# CONFIG_SYSFS_DEPRECATED is not set
-# CONFIG_RELAY is not set
-CONFIG_BLK_DEV_INITRD=y
-CONFIG_INITRAMFS_SOURCE=""
-# CONFIG_RD_GZIP is not set
-# CONFIG_RD_BZIP2 is not set
-# CONFIG_RD_LZMA is not set
-# CONFIG_RD_XZ is not set
-# CONFIG_RD_LZO is not set
-# CONFIG_RD_LZ4 is not set
-# CONFIG_CC_OPTIMIZE_FOR_PERFORMANCE is not set
-CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-CONFIG_SYSCTL=y
-CONFIG_ANON_INODES=y
-CONFIG_HAVE_UID16=y
-CONFIG_BPF=y
-CONFIG_EXPERT=y
-CONFIG_UID16=y
-CONFIG_MULTIUSER=y
-# CONFIG_SGETMASK_SYSCALL is not set
-CONFIG_SYSFS_SYSCALL=y
-# CONFIG_SYSCTL_SYSCALL is not set
-CONFIG_KALLSYMS=y
-CONFIG_KALLSYMS_ALL=y
-# CONFIG_KALLSYMS_ABSOLUTE_PERCPU is not set
-CONFIG_KALLSYMS_BASE_RELATIVE=y
-CONFIG_PRINTK=y
-CONFIG_PRINTK_NMI=y
-CONFIG_BUG=y
-CONFIG_ELF_CORE=y
-# CONFIG_BASE_FULL is not set
-CONFIG_FUTEX=y
-CONFIG_EPOLL=y
-CONFIG_SIGNALFD=y
-CONFIG_TIMERFD=y
-CONFIG_EVENTFD=y
-# CONFIG_BPF_SYSCALL is not set
-CONFIG_SHMEM=y
-CONFIG_AIO=y
-# CONFIG_ADVISE_SYSCALLS is not set
-# CONFIG_USERFAULTFD is not set
-CONFIG_MEMBARRIER=y
-CONFIG_EMBEDDED=y
-CONFIG_HAVE_PERF_EVENTS=y
-CONFIG_PERF_USE_VMALLOC=y
-
-#
-# Kernel Performance Events And Counters
-#
-CONFIG_PERF_EVENTS=y
-# CONFIG_DEBUG_PERF_USE_VMALLOC is not set
-# CONFIG_VM_EVENT_COUNTERS is not set
-# CONFIG_SLUB_DEBUG is not set
-CONFIG_COMPAT_BRK=y
-# CONFIG_SLAB is not set
-CONFIG_SLUB=y
-# CONFIG_SLOB is not set
-# CONFIG_SLAB_FREELIST_RANDOM is not set
-# CONFIG_SYSTEM_DATA_VERIFICATION is not set
-# CONFIG_PROFILING is not set
-CONFIG_HAVE_OPROFILE=y
-# CONFIG_KPROBES is not set
-CONFIG_JUMP_LABEL=y
-# CONFIG_STATIC_KEYS_SELFTEST is not set
-# CONFIG_UPROBES is not set
-# CONFIG_HAVE_64BIT_ALIGNED_ACCESS is not set
-CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS=y
-CONFIG_ARCH_USE_BUILTIN_BSWAP=y
-CONFIG_HAVE_KPROBES=y
-CONFIG_HAVE_KRETPROBES=y
-CONFIG_HAVE_NMI=y
-CONFIG_HAVE_ARCH_TRACEHOOK=y
-CONFIG_HAVE_DMA_CONTIGUOUS=y
-CONFIG_GENERIC_SMP_IDLE_THREAD=y
-CONFIG_GENERIC_IDLE_POLL_SETUP=y
-CONFIG_HAVE_REGS_AND_STACK_ACCESS_API=y
-CONFIG_HAVE_CLK=y
-CONFIG_HAVE_DMA_API_DEBUG=y
-CONFIG_HAVE_HW_BREAKPOINT=y
-CONFIG_HAVE_PERF_REGS=y
-CONFIG_HAVE_PERF_USER_STACK_DUMP=y
-CONFIG_HAVE_ARCH_JUMP_LABEL=y
-CONFIG_ARCH_WANT_IPC_PARSE_VERSION=y
-CONFIG_HAVE_ARCH_SECCOMP_FILTER=y
-CONFIG_HAVE_GCC_PLUGINS=y
-# CONFIG_GCC_PLUGINS is not set
-CONFIG_HAVE_CC_STACKPROTECTOR=y
-CONFIG_CC_STACKPROTECTOR=y
-# CONFIG_CC_STACKPROTECTOR_NONE is not set
-CONFIG_CC_STACKPROTECTOR_REGULAR=y
-# CONFIG_CC_STACKPROTECTOR_STRONG is not set
-CONFIG_HAVE_CONTEXT_TRACKING=y
-CONFIG_HAVE_VIRT_CPU_ACCOUNTING_GEN=y
-CONFIG_HAVE_IRQ_TIME_ACCOUNTING=y
-CONFIG_HAVE_MOD_ARCH_SPECIFIC=y
-CONFIG_MODULES_USE_ELF_REL=y
-CONFIG_ARCH_HAS_ELF_RANDOMIZE=y
-CONFIG_HAVE_ARCH_MMAP_RND_BITS=y
-CONFIG_HAVE_EXIT_THREAD=y
-CONFIG_ARCH_MMAP_RND_BITS_MIN=8
-CONFIG_ARCH_MMAP_RND_BITS_MAX=16
-CONFIG_ARCH_MMAP_RND_BITS=8
-# CONFIG_HAVE_ARCH_HASH is not set
-# CONFIG_ISA_BUS_API is not set
-CONFIG_CLONE_BACKWARDS=y
-CONFIG_OLD_SIGSUSPEND3=y
-CONFIG_OLD_SIGACTION=y
-# CONFIG_CPU_NO_EFFICIENT_FFS is not set
-# CONFIG_HAVE_ARCH_VMAP_STACK is not set
-
-#
-# GCOV-based kernel profiling
-#
-# CONFIG_GCOV_KERNEL is not set
-CONFIG_ARCH_HAS_GCOV_PROFILE_ALL=y
-CONFIG_HAVE_GENERIC_DMA_COHERENT=y
-CONFIG_RT_MUTEXES=y
-CONFIG_BASE_SMALL=1
-CONFIG_MODULES=y
-CONFIG_MODULE_FORCE_LOAD=y
-CONFIG_MODULE_UNLOAD=y
-# CONFIG_MODULE_FORCE_UNLOAD is not set
-# CONFIG_MODVERSIONS is not set
-# CONFIG_MODULE_SRCVERSION_ALL is not set
-# CONFIG_MODULE_SIG is not set
-# CONFIG_MODULE_COMPRESS is not set
-# CONFIG_TRIM_UNUSED_KSYMS is not set
-CONFIG_MODULES_TREE_LOOKUP=y
-CONFIG_BLOCK=y
-# CONFIG_LBDAF is not set
-# CONFIG_BLK_DEV_BSG is not set
-# CONFIG_BLK_DEV_BSGLIB is not set
-# CONFIG_BLK_DEV_INTEGRITY is not set
-# CONFIG_BLK_CMDLINE_PARSER is not set
-
-#
-# Partition Types
-#
-# CONFIG_PARTITION_ADVANCED is not set
-CONFIG_MSDOS_PARTITION=y
-CONFIG_EFI_PARTITION=y
-
-#
-# IO Schedulers
-#
-CONFIG_IOSCHED_NOOP=y
-CONFIG_IOSCHED_DEADLINE=y
-# CONFIG_IOSCHED_CFQ is not set
-CONFIG_DEFAULT_DEADLINE=y
-# CONFIG_DEFAULT_NOOP is not set
-CONFIG_DEFAULT_IOSCHED="deadline"
-CONFIG_UNINLINE_SPIN_UNLOCK=y
-CONFIG_ARCH_SUPPORTS_ATOMIC_RMW=y
-# CONFIG_FREEZER is not set
-
-#
-# System Type
-#
-CONFIG_MMU=y
-# CONFIG_ARCH_INFINITY2 is not set
-CONFIG_ARCH_MULTIPLATFORM=y
-# CONFIG_ARCH_GEMINI is not set
-# CONFIG_ARCH_EBSA110 is not set
-# CONFIG_ARCH_EP93XX is not set
-# CONFIG_ARCH_FOOTBRIDGE is not set
-# CONFIG_ARCH_NETX is not set
-# CONFIG_ARCH_IOP13XX is not set
-# CONFIG_ARCH_IOP32X is not set
-# CONFIG_ARCH_IOP33X is not set
-# CONFIG_ARCH_IXP4XX is not set
-# CONFIG_ARCH_DOVE is not set
-# CONFIG_ARCH_KS8695 is not set
-# CONFIG_ARCH_W90X900 is not set
-# CONFIG_ARCH_LPC32XX is not set
-# CONFIG_ARCH_PXA is not set
-# CONFIG_ARCH_RPC is not set
-# CONFIG_ARCH_SA1100 is not set
-# CONFIG_ARCH_S3C24XX is not set
-# CONFIG_ARCH_DAVINCI is not set
-# CONFIG_ARCH_OMAP1 is not set
-
-#
-# Multiple platform selection
-#
-
-#
-# CPU Core family selection
-#
-# CONFIG_ARCH_MULTI_V6 is not set
-CONFIG_ARCH_MULTI_V7=y
-CONFIG_ARCH_MULTI_V6_V7=y
-# CONFIG_ARCH_MULTI_CPU_AUTO is not set
-# CONFIG_ARCH_VIRT is not set
-# CONFIG_ARCH_MVEBU is not set
-# CONFIG_ARCH_ALPINE is not set
-# CONFIG_ARCH_ARTPEC is not set
-# CONFIG_ARCH_AT91 is not set
-# CONFIG_ARCH_BCM is not set
-# CONFIG_ARCH_BERLIN is not set
-# CONFIG_ARCH_DIGICOLOR is not set
-# CONFIG_ARCH_HIGHBANK is not set
-# CONFIG_ARCH_HISI is not set
-# CONFIG_ARCH_KEYSTONE is not set
-# CONFIG_ARCH_MESON is not set
-CONFIG_ARCH_SSTAR=y
-# CONFIG_SS_DUALOS is not set
-
-#
-# Options
-#
-CONFIG_SS_DTB_NAME="infinity6b0-ssc009b-s01a"
-CONFIG_SS_BUILTIN_DTB=y
-CONFIG_MS_KERNEL_TYPE=""
-CONFIG_SSTAR_CHIP_NAME="infinity6b0"
-CONFIG_SSTAR_SHORT_NAME="I6B0"
-# CONFIG_MP_IRQ_TRACE is not set
-CONFIG_SKIP_SQUASHFS_BAD_BLOCK=y
-
-#
-# Fast boot
-#
-# CONFIG_SS_BUILTIN_UNFDT is not set
-# CONFIG_FB_DTS_SKIP_CRC is not set
-# CONFIG_FB_DTS_SCAN_MEMORY_ONCE is not set
-# CONFIG_FB_DTS_SKIP_ATAGS_TO_FDT is not set
-CONFIG_DISABLE_CLK_DEBUGFS_SUPPORT=y
-CONFIG_DEFERRED_INIICALLS=y
-# CONFIG_DEFERRED_INIICALLS_SLAB_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_PARAM_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_PPERF_SYSFS is not set
-# CONFIG_DEFERRED_INIICALLS_MORE_SYSFS is not set
-# CONFIG_DEFERRED_CREATE_DTS_SYSNODE is not set
-# CONFIG_CRYPTO_MANAGER_NO_TESTS_THREAD is not set
-CONFIG_ARCH_INFINITY6B0=y
-CONFIG_SS_PROFILING_TIME=y
-# CONFIG_ARCH_MXC is not set
-# CONFIG_ARCH_MEDIATEK is not set
-
-#
-# TI OMAP/AM/DM/DRA Family
-#
-# CONFIG_ARCH_OMAP3 is not set
-# CONFIG_ARCH_OMAP4 is not set
-# CONFIG_SOC_OMAP5 is not set
-# CONFIG_SOC_AM33XX is not set
-# CONFIG_SOC_AM43XX is not set
-# CONFIG_SOC_DRA7XX is not set
-# CONFIG_ARCH_MMP is not set
-# CONFIG_ARCH_QCOM is not set
-# CONFIG_ARCH_REALVIEW is not set
-# CONFIG_ARCH_ROCKCHIP is not set
-# CONFIG_ARCH_SOCFPGA is not set
-# CONFIG_PLAT_SPEAR is not set
-# CONFIG_ARCH_STI is not set
-# CONFIG_ARCH_S5PV210 is not set
-# CONFIG_ARCH_EXYNOS is not set
-# CONFIG_ARCH_RENESAS is not set
-# CONFIG_ARCH_SUNXI is not set
-# CONFIG_ARCH_SIRF is not set
-# CONFIG_ARCH_TANGO is not set
-# CONFIG_ARCH_TEGRA is not set
-# CONFIG_ARCH_UNIPHIER is not set
-# CONFIG_ARCH_U8500 is not set
-# CONFIG_ARCH_VEXPRESS is not set
-# CONFIG_ARCH_WM8850 is not set
-# CONFIG_ARCH_ZX is not set
-# CONFIG_ARCH_ZYNQ is not set
-
-#
-# Processor Type
-#
-CONFIG_CPU_V7=y
-CONFIG_CPU_32v6K=y
-CONFIG_CPU_32v7=y
-CONFIG_CPU_ABRT_EV7=y
-CONFIG_CPU_PABRT_V7=y
-CONFIG_CPU_CACHE_V7=y
-CONFIG_CPU_CACHE_VIPT=y
-CONFIG_CPU_COPY_V6=y
-CONFIG_CPU_TLB_V7=y
-CONFIG_CPU_HAS_ASID=y
-CONFIG_CPU_CP15=y
-CONFIG_CPU_CP15_MMU=y
-
-#
-# Processor Features
-#
-# CONFIG_ARM_LPAE is not set
-# CONFIG_ARCH_PHYS_ADDR_T_64BIT is not set
-CONFIG_ARM_THUMB=y
-CONFIG_ARM_THUMBEE=y
-CONFIG_ARM_VIRT_EXT=y
-# CONFIG_SWP_EMULATE is not set
-# CONFIG_CPU_ICACHE_DISABLE is not set
-# CONFIG_CPU_DCACHE_DISABLE is not set
-# CONFIG_CPU_BPREDICT_DISABLE is not set
-CONFIG_KUSER_HELPERS=y
-CONFIG_VDSO=y
-CONFIG_MIGHT_HAVE_CACHE_L2X0=y
-# CONFIG_CACHE_L2X0 is not set
-CONFIG_ARM_L1_CACHE_SHIFT_6=y
-CONFIG_ARM_L1_CACHE_SHIFT=6
-CONFIG_ARM_DMA_MEM_BUFFERABLE=y
-# CONFIG_DEBUG_RODATA is not set
-CONFIG_MULTI_IRQ_HANDLER=y
-# CONFIG_ARM_ERRATA_430973 is not set
-# CONFIG_ARM_ERRATA_720789 is not set
-# CONFIG_ARM_ERRATA_754322 is not set
-# CONFIG_ARM_ERRATA_775420 is not set
-# CONFIG_ARM_ERRATA_773022 is not set
-# CONFIG_ARM_ERRATA_818325_852422 is not set
-# CONFIG_ARM_ERRATA_821420 is not set
-# CONFIG_ARM_ERRATA_825619 is not set
-# CONFIG_ARM_ERRATA_852421 is not set
-# CONFIG_ARM_ERRATA_852423 is not set
-
-#
-# Bus support
-#
-# CONFIG_PCI is not set
-# CONFIG_PCI_DOMAINS_GENERIC is not set
-# CONFIG_PCI_SYSCALL is not set
-# CONFIG_PCCARD is not set
-
-#
-# Kernel Features
-#
-CONFIG_HAVE_SMP=y
-# CONFIG_SMP is not set
-CONFIG_HAVE_ARM_ARCH_TIMER=y
-CONFIG_VMSPLIT_3G=y
-# CONFIG_VMSPLIT_3G_OPT is not set
-# CONFIG_VMSPLIT_2G is not set
-# CONFIG_VMSPLIT_1G is not set
-CONFIG_PAGE_OFFSET=0xC0000000
-# CONFIG_ARM_PSCI is not set
-CONFIG_ARCH_NR_GPIO=0
-# CONFIG_PREEMPT_NONE is not set
-# CONFIG_PREEMPT_VOLUNTARY is not set
-CONFIG_PREEMPT=y
-CONFIG_PREEMPT_COUNT=y
-CONFIG_HZ_FIXED=0
-CONFIG_HZ_100=y
-# CONFIG_HZ_200 is not set
-# CONFIG_HZ_250 is not set
-# CONFIG_HZ_300 is not set
-# CONFIG_HZ_500 is not set
-# CONFIG_HZ_1000 is not set
-CONFIG_HZ=100
-CONFIG_SCHED_HRTICK=y
-CONFIG_THUMB2_KERNEL=y
-CONFIG_THUMB2_AVOID_R_ARM_THM_JUMP11=y
-CONFIG_ARM_ASM_UNIFIED=y
-CONFIG_ARM_PATCH_IDIV=y
-CONFIG_AEABI=y
-# CONFIG_ARCH_SPARSEMEM_DEFAULT is not set
-# CONFIG_ARCH_SELECT_MEMORY_MODEL is not set
-CONFIG_HAVE_ARCH_PFN_VALID=y
-# CONFIG_HIGHMEM is not set
-CONFIG_CPU_SW_DOMAIN_PAN=y
-CONFIG_HW_PERF_EVENTS=y
-CONFIG_ARCH_WANT_GENERAL_HUGETLB=y
-# CONFIG_ARM_MODULE_PLTS is not set
-CONFIG_FLATMEM=y
-CONFIG_FLAT_NODE_MEM_MAP=y
-CONFIG_HAVE_MEMBLOCK=y
-CONFIG_NO_BOOTMEM=y
-CONFIG_MEMORY_ISOLATION=y
-# CONFIG_HAVE_BOOTMEM_INFO_NODE is not set
-CONFIG_SPLIT_PTLOCK_CPUS=4
-CONFIG_COMPACTION=y
-CONFIG_MIGRATION=y
-# CONFIG_PHYS_ADDR_T_64BIT is not set
-# CONFIG_KSM is not set
-CONFIG_DEFAULT_MMAP_MIN_ADDR=4096
-CONFIG_NEED_PER_CPU_KM=y
-# CONFIG_CLEANCACHE is not set
-CONFIG_CMA=y
-CONFIG_CMA_DEBUG=y
-CONFIG_CMA_DEBUGFS=y
-CONFIG_CMA_AREAS=1
-# CONFIG_ZPOOL is not set
-# CONFIG_ZBUD is not set
-# CONFIG_ZSMALLOC is not set
-CONFIG_GENERIC_EARLY_IOREMAP=y
-# CONFIG_IDLE_PAGE_TRACKING is not set
-CONFIG_FORCE_MAX_ZONEORDER=10
-CONFIG_ALIGNMENT_TRAP=y
-# CONFIG_UACCESS_WITH_MEMCPY is not set
-# CONFIG_SECCOMP is not set
-CONFIG_SWIOTLB=y
-CONFIG_IOMMU_HELPER=y
-# CONFIG_PARAVIRT is not set
-# CONFIG_PARAVIRT_TIME_ACCOUNTING is not set
-# CONFIG_XEN is not set
-
-#
-# Boot options
-#
-CONFIG_USE_OF=y
-CONFIG_ATAGS=y
-# CONFIG_DEPRECATED_PARAM_STRUCT is not set
-CONFIG_ZBOOT_ROM_TEXT=0
-CONFIG_ZBOOT_ROM_BSS=0
-CONFIG_ARM_APPENDED_DTB=y
-CONFIG_ARM_ATAG_DTB_COMPAT=y
-CONFIG_ARM_ATAG_DTB_COMPAT_CMDLINE_FROM_BOOTLOADER=y
-# CONFIG_ARM_ATAG_DTB_COMPAT_CMDLINE_EXTEND is not set
-CONFIG_CMDLINE=""
-# CONFIG_KEXEC is not set
-# CONFIG_CRASH_DUMP is not set
-CONFIG_AUTO_ZRELADDR=y
-# CONFIG_EFI is not set
-
-#
-# CPU Power Management
-#
-
-#
-# CPU Frequency scaling
-#
-CONFIG_CPU_FREQ=y
-CONFIG_CPU_FREQ_GOV_ATTR_SET=y
-CONFIG_CPU_FREQ_GOV_COMMON=y
-CONFIG_CPU_FREQ_STAT=y
-CONFIG_CPU_FREQ_STAT_DETAILS=y
-# CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE is not set
-# CONFIG_CPU_FREQ_DEFAULT_GOV_POWERSAVE is not set
-# CONFIG_CPU_FREQ_DEFAULT_GOV_USERSPACE is not set
-CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND=y
-# CONFIG_CPU_FREQ_DEFAULT_GOV_CONSERVATIVE is not set
-CONFIG_CPU_FREQ_GOV_PERFORMANCE=y
-CONFIG_CPU_FREQ_GOV_POWERSAVE=y
-CONFIG_CPU_FREQ_GOV_USERSPACE=y
-CONFIG_CPU_FREQ_GOV_ONDEMAND=y
-# CONFIG_CPU_FREQ_GOV_CONSERVATIVE is not set
-
-#
-# CPU frequency scaling drivers
-#
-# CONFIG_CPUFREQ_DT is not set
-# CONFIG_ARM_KIRKWOOD_CPUFREQ is not set
-# CONFIG_QORIQ_CPUFREQ is not set
-
-#
-# CPU Idle
-#
-# CONFIG_CPU_IDLE is not set
-# CONFIG_ARCH_NEEDS_CPU_IDLE_COUPLED is not set
-
-#
-# Floating point emulation
-#
-
-#
-# At least one emulation must be selected
-#
-CONFIG_VFP=y
-CONFIG_VFPv3=y
-CONFIG_NEON=y
-CONFIG_KERNEL_MODE_NEON=y
-
-#
-# Userspace binary formats
-#
-CONFIG_BINFMT_ELF=y
-CONFIG_ELFCORE=y
-CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS=y
-CONFIG_BINFMT_SCRIPT=y
-# CONFIG_BINFMT_FLAT is not set
-# CONFIG_HAVE_AOUT is not set
-# CONFIG_BINFMT_MISC is not set
-CONFIG_COREDUMP=y
-
-#
-# Power management options
-#
-# CONFIG_SUSPEND is not set
-# CONFIG_PM is not set
-# CONFIG_APM_EMULATION is not set
-CONFIG_PM_OPP=y
-CONFIG_ARCH_SUSPEND_POSSIBLE=y
-# CONFIG_ARM_CPU_SUSPEND is not set
-CONFIG_ARCH_HIBERNATION_POSSIBLE=y
-CONFIG_NET=y
-
-#
-# Networking options
-#
-CONFIG_PACKET=y
-# CONFIG_PACKET_DIAG is not set
-CONFIG_UNIX=y
-# CONFIG_UNIX_DIAG is not set
-# CONFIG_XFRM_USER is not set
-# CONFIG_NET_KEY is not set
-CONFIG_INET=y
-CONFIG_IP_MULTICAST=y
-CONFIG_IP_ADVANCED_ROUTER=y
-# CONFIG_IP_FIB_TRIE_STATS is not set
-# CONFIG_IP_MULTIPLE_TABLES is not set
-CONFIG_IP_ROUTE_MULTIPATH=y
-CONFIG_IP_ROUTE_VERBOSE=y
-CONFIG_IP_PNP=y
-CONFIG_IP_PNP_DHCP=y
-# CONFIG_NET_IPIP is not set
-# CONFIG_NET_IPGRE_DEMUX is not set
-# CONFIG_NET_IP_TUNNEL is not set
-# CONFIG_IP_MROUTE is not set
-CONFIG_SYN_COOKIES=y
-# CONFIG_NET_UDP_TUNNEL is not set
-# CONFIG_NET_FOU is not set
-# CONFIG_INET_AH is not set
-# CONFIG_INET_ESP is not set
-# CONFIG_INET_IPCOMP is not set
-# CONFIG_INET_XFRM_TUNNEL is not set
-# CONFIG_INET_TUNNEL is not set
-# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-# CONFIG_INET_XFRM_MODE_BEET is not set
-# CONFIG_INET_DIAG is not set
-# CONFIG_TCP_CONG_ADVANCED is not set
-# CONFIG_TCP_CONG_BIC is not set
-CONFIG_TCP_CONG_CUBIC=y
-# CONFIG_TCP_CONG_WESTWOOD is not set
-# CONFIG_TCP_CONG_HTCP is not set
-# CONFIG_TCP_CONG_HSTCP is not set
-# CONFIG_TCP_CONG_HYBLA is not set
-# CONFIG_TCP_CONG_VEGAS is not set
-# CONFIG_TCP_CONG_NV is not set
-# CONFIG_TCP_CONG_SCALABLE is not set
-# CONFIG_TCP_CONG_LP is not set
-# CONFIG_TCP_CONG_VENO is not set
-# CONFIG_TCP_CONG_YEAH is not set
-# CONFIG_TCP_CONG_ILLINOIS is not set
-# CONFIG_TCP_CONG_DCTCP is not set
-# CONFIG_TCP_CONG_CDG is not set
-# CONFIG_TCP_CONG_BBR is not set
-CONFIG_DEFAULT_CUBIC=y
-# CONFIG_DEFAULT_RENO is not set
-CONFIG_DEFAULT_TCP_CONG="cubic"
-# CONFIG_TCP_MD5SIG is not set
-# CONFIG_IPV6 is not set
-# CONFIG_NETWORK_SECMARK is not set
-# CONFIG_NET_PTP_CLASSIFY is not set
-# CONFIG_NETWORK_PHY_TIMESTAMPING is not set
-# CONFIG_NETFILTER is not set
-# CONFIG_IP_DCCP is not set
-# CONFIG_IP_SCTP is not set
-# CONFIG_RDS is not set
-# CONFIG_TIPC is not set
-# CONFIG_ATM is not set
-# CONFIG_L2TP is not set
-CONFIG_BRIDGE=y
-CONFIG_HAVE_NET_DSA=y
-# CONFIG_NET_DSA is not set
-# CONFIG_VLAN_8021Q is not set
-# CONFIG_DECNET is not set
-# CONFIG_LLC2 is not set
-# CONFIG_IPX is not set
-# CONFIG_ATALK is not set
-# CONFIG_X25 is not set
-# CONFIG_LAPB is not set
-# CONFIG_PHONET is not set
-# CONFIG_IEEE802154 is not set
-# CONFIG_NET_SCHED is not set
-# CONFIG_DCB is not set
-# CONFIG_BATMAN_ADV is not set
-# CONFIG_OPENVSWITCH is not set
-# CONFIG_VSOCKETS is not set
-# CONFIG_NETLINK_DIAG is not set
-# CONFIG_MPLS is not set
-# CONFIG_HSR is not set
-# CONFIG_NET_SWITCHDEV is not set
-# CONFIG_NET_L3_MASTER_DEV is not set
-# CONFIG_NET_NCSI is not set
-# CONFIG_SOCK_CGROUP_DATA is not set
-# CONFIG_CGROUP_NET_PRIO is not set
-# CONFIG_CGROUP_NET_CLASSID is not set
-CONFIG_NET_RX_BUSY_POLL=y
-CONFIG_BQL=y
-# CONFIG_BPF_JIT is not set
-
-#
-# Network testing
-#
-# CONFIG_NET_PKTGEN is not set
-# CONFIG_HAMRADIO is not set
-# CONFIG_CAN is not set
-# CONFIG_IRDA is not set
-# CONFIG_BT is not set
-# CONFIG_AF_RXRPC is not set
-# CONFIG_AF_KCM is not set
-# CONFIG_STREAM_PARSER is not set
-CONFIG_WIRELESS=y
-CONFIG_WIRELESS_EXT=y
-CONFIG_WEXT_CORE=y
-CONFIG_WEXT_PROC=y
-CONFIG_WEXT_PRIV=y
-CONFIG_CFG80211=m
-# CONFIG_NL80211_TESTMODE is not set
-# CONFIG_CFG80211_DEVELOPER_WARNINGS is not set
-# CONFIG_CFG80211_CERTIFICATION_ONUS is not set
-CONFIG_CFG80211_DEFAULT_PS=y
-# CONFIG_CFG80211_DEBUGFS is not set
-# CONFIG_CFG80211_INTERNAL_REGDB is not set
-CONFIG_CFG80211_CRDA_SUPPORT=y
-CONFIG_CFG80211_WEXT=y
-# CONFIG_LIB80211 is not set
-CONFIG_MAC80211=m
-CONFIG_MAC80211_HAS_RC=y
-CONFIG_MAC80211_RC_MINSTREL=y
-CONFIG_MAC80211_RC_MINSTREL_HT=y
-# CONFIG_MAC80211_RC_MINSTREL_VHT is not set
-CONFIG_MAC80211_RC_DEFAULT_MINSTREL=y
-CONFIG_MAC80211_RC_DEFAULT="minstrel_ht"
-CONFIG_MAC80211_MESH=y
-# CONFIG_MAC80211_DEBUGFS is not set
-# CONFIG_MAC80211_MESSAGE_TRACING is not set
-# CONFIG_MAC80211_DEBUG_MENU is not set
-CONFIG_MAC80211_STA_HASH_MAX_SIZE=0
-# CONFIG_WIMAX is not set
-# CONFIG_RFKILL is not set
-# CONFIG_NET_9P is not set
-# CONFIG_CAIF is not set
-# CONFIG_CEPH_LIB is not set
-# CONFIG_NFC is not set
-# CONFIG_LWTUNNEL is not set
-# CONFIG_DST_CACHE is not set
-# CONFIG_NET_DEVLINK is not set
-CONFIG_MAY_USE_DEVLINK=y
-CONFIG_HAVE_CBPF_JIT=y
-
-#
-# Device Drivers
-#
-
-#
-# Generic Driver Options
-#
-CONFIG_UEVENT_HELPER=y
-CONFIG_UEVENT_HELPER_PATH="/sbin/mdev"
-CONFIG_DEVTMPFS=y
-CONFIG_DEVTMPFS_MOUNT=y
-# CONFIG_STANDALONE is not set
-# CONFIG_PREVENT_FIRMWARE_BUILD is not set
-# CONFIG_FW_LOADER is not set
-# CONFIG_ALLOW_DEV_COREDUMP is not set
-# CONFIG_DEBUG_DRIVER is not set
-# CONFIG_DEBUG_DEVRES is not set
-# CONFIG_DEBUG_TEST_DRIVER_REMOVE is not set
-# CONFIG_SYS_HYPERVISOR is not set
-# CONFIG_GENERIC_CPU_DEVICES is not set
-CONFIG_SOC_BUS=y
-CONFIG_REGMAP=y
-CONFIG_REGMAP_I2C=y
-CONFIG_REGMAP_SPI=y
-# CONFIG_DMA_SHARED_BUFFER is not set
-CONFIG_DMA_CMA=y
-
-#
-# Default contiguous memory area size:
-#
-CONFIG_CMA_SIZE_MBYTES=2
-CONFIG_CMA_SIZE_SEL_MBYTES=y
-# CONFIG_CMA_SIZE_SEL_PERCENTAGE is not set
-# CONFIG_CMA_SIZE_SEL_MIN is not set
-# CONFIG_CMA_SIZE_SEL_MAX is not set
-CONFIG_CMA_ALIGNMENT=4
-
-#
-# Bus devices
-#
-# CONFIG_ARM_CCI400_PMU is not set
-# CONFIG_ARM_CCI5xx_PMU is not set
-# CONFIG_ARM_CCN is not set
-# CONFIG_BRCMSTB_GISB_ARB is not set
-# CONFIG_VEXPRESS_CONFIG is not set
-# CONFIG_CONNECTOR is not set
-CONFIG_MTD=y
-CONFIG_MTD_TESTS=m
-# CONFIG_MTD_SS_TESTS is not set
-# CONFIG_MTD_REDBOOT_PARTS is not set
-CONFIG_MTD_CMDLINE_PARTS=y
-# CONFIG_MTD_AFS_PARTS is not set
-# CONFIG_MTD_OF_PARTS is not set
-# CONFIG_MTD_AR7_PARTS is not set
-
-#
-# User Modules And Translation Layers
-#
-CONFIG_MTD_BLKDEVS=y
-CONFIG_MTD_BLOCK=y
-# CONFIG_FTL is not set
-# CONFIG_NFTL is not set
-# CONFIG_INFTL is not set
-# CONFIG_RFD_FTL is not set
-# CONFIG_SSFDC is not set
-# CONFIG_SM_FTL is not set
-# CONFIG_MTD_OOPS is not set
-# CONFIG_MTD_PARTITIONED_MASTER is not set
-
-#
-# RAM/ROM/Flash chip drivers
-#
-# CONFIG_MTD_CFI is not set
-# CONFIG_MTD_JEDECPROBE is not set
-CONFIG_MTD_MAP_BANK_WIDTH_1=y
-CONFIG_MTD_MAP_BANK_WIDTH_2=y
-CONFIG_MTD_MAP_BANK_WIDTH_4=y
-# CONFIG_MTD_MAP_BANK_WIDTH_8 is not set
-# CONFIG_MTD_MAP_BANK_WIDTH_16 is not set
-# CONFIG_MTD_MAP_BANK_WIDTH_32 is not set
-CONFIG_MTD_CFI_I1=y
-CONFIG_MTD_CFI_I2=y
-# CONFIG_MTD_CFI_I4 is not set
-# CONFIG_MTD_CFI_I8 is not set
-CONFIG_MTD_RAM=y
-# CONFIG_MTD_ROM is not set
-# CONFIG_MTD_ABSENT is not set
-
-#
-# Mapping drivers for chip access
-#
-# CONFIG_MTD_COMPLEX_MAPPINGS is not set
-CONFIG_MTD_PHYSMAP_OF=y
-CONFIG_MTD_PLATRAM=y
-
-#
-# Self-contained MTD device drivers
-#
-# CONFIG_MTD_DATAFLASH is not set
-# CONFIG_MTD_M25P80 is not set
-# CONFIG_MTD_SST25L is not set
-# CONFIG_MTD_SLRAM is not set
-# CONFIG_MTD_PHRAM is not set
-# CONFIG_MTD_MTDRAM is not set
-# CONFIG_MTD_BLOCK2MTD is not set
-
-#
-# Disk-On-Chip Device Drivers
-#
-# CONFIG_MTD_DOCG3 is not set
-CONFIG_MTD_NAND_ECC=m
-# CONFIG_MTD_NAND_ECC_SMC is not set
-CONFIG_MTD_NAND=m
-# CONFIG_MTD_NAND_ECC_BCH is not set
-# CONFIG_MTD_SM_COMMON is not set
-# CONFIG_MTD_NAND_DENALI_DT is not set
-# CONFIG_MTD_NAND_GPIO is not set
-# CONFIG_MTD_NAND_OMAP_BCH_BUILD is not set
-CONFIG_MTD_NAND_IDS=m
-# CONFIG_MTD_NAND_DISKONCHIP is not set
-# CONFIG_MTD_NAND_DOCG4 is not set
-# CONFIG_MTD_NAND_NANDSIM is not set
-# CONFIG_MTD_NAND_BRCMNAND is not set
-# CONFIG_MTD_NAND_PLATFORM is not set
-# CONFIG_MTD_NAND_HISI504 is not set
-# CONFIG_MTD_NAND_MTK is not set
-# CONFIG_MTD_ONENAND is not set
-
-#
-# LPDDR & LPDDR2 PCM memory drivers
-#
-# CONFIG_MTD_LPDDR is not set
-# CONFIG_MTD_LPDDR2_NVM is not set
-CONFIG_MTD_SPI_NOR=y
-# CONFIG_MTD_MT81xx_NOR is not set
-CONFIG_MTD_SPI_NOR_USE_4K_SECTORS=y
-# CONFIG_SPI_CADENCE_QUADSPI is not set
-CONFIG_MTD_UBI=y
-CONFIG_MTD_UBI_WL_THRESHOLD=4096
-CONFIG_MTD_UBI_BEB_LIMIT=20
-# CONFIG_MTD_UBI_FASTMAP is not set
-# CONFIG_MTD_UBI_GLUEBI is not set
-# CONFIG_MTD_UBI_BLOCK is not set
-CONFIG_DTC=y
-CONFIG_OF=y
-# CONFIG_OF_UNITTEST is not set
-CONFIG_OF_FLATTREE=y
-CONFIG_OF_EARLY_FLATTREE=y
-CONFIG_OF_ADDRESS=y
-CONFIG_OF_IRQ=y
-CONFIG_OF_NET=y
-CONFIG_OF_MDIO=y
-CONFIG_OF_RESERVED_MEM=y
-# CONFIG_OF_OVERLAY is not set
-CONFIG_ARCH_MIGHT_HAVE_PC_PARPORT=y
-# CONFIG_PARPORT is not set
-CONFIG_BLK_DEV=y
-# CONFIG_BLK_DEV_NULL_BLK is not set
-# CONFIG_BLK_DEV_COW_COMMON is not set
-CONFIG_BLK_DEV_LOOP=y
-# CONFIG_BLK_DEV_DRBD is not set
-# CONFIG_BLK_DEV_NBD is not set
-CONFIG_BLK_DEV_RAM=y
-CONFIG_BLK_DEV_RAM_COUNT=16
-CONFIG_BLK_DEV_RAM_SIZE=65536
-# CONFIG_CDROM_PKTCDVD is not set
-# CONFIG_ATA_OVER_ETH is not set
-# CONFIG_MG_DISK is not set
-# CONFIG_BLK_DEV_RBD is not set
-# CONFIG_NVME_TARGET is not set
-
-#
-# Misc devices
-#
-# CONFIG_AD525X_DPOT is not set
-# CONFIG_DUMMY_IRQ is not set
-# CONFIG_ICS932S401 is not set
-# CONFIG_ENCLOSURE_SERVICES is not set
-# CONFIG_APDS9802ALS is not set
-# CONFIG_ISL29003 is not set
-# CONFIG_ISL29020 is not set
-# CONFIG_SENSORS_TSL2550 is not set
-# CONFIG_SENSORS_BH1770 is not set
-# CONFIG_SENSORS_APDS990X is not set
-# CONFIG_HMC6352 is not set
-# CONFIG_DS1682 is not set
-# CONFIG_TI_DAC7512 is not set
-# CONFIG_USB_SWITCH_FSA9480 is not set
-# CONFIG_LATTICE_ECP3_CONFIG is not set
-# CONFIG_SRAM is not set
-# CONFIG_C2PORT is not set
-
-#
-# EEPROM support
-#
-CONFIG_EEPROM_AT24=m
-# CONFIG_EEPROM_AT25 is not set
-CONFIG_EEPROM_LEGACY=m
-# CONFIG_EEPROM_MAX6875 is not set
-# CONFIG_EEPROM_93CX6 is not set
-# CONFIG_EEPROM_93XX46 is not set
-
-#
-# Texas Instruments shared transport line discipline
-#
-# CONFIG_TI_ST is not set
-
-#
-# Altera FPGA firmware download module
-#
-# CONFIG_ALTERA_STAPL is not set
-
-#
-# Intel MIC Bus Driver
-#
-
-#
-# SCIF Bus Driver
-#
-
-#
-# VOP Bus Driver
-#
-
-#
-# Intel MIC Host Driver
-#
-
-#
-# Intel MIC Card Driver
-#
-
-#
-# SCIF Driver
-#
-
-#
-# Intel MIC Coprocessor State Management (COSM) Drivers
-#
-
-#
-# VOP Driver
-#
-# CONFIG_ECHO is not set
-# CONFIG_CXL_BASE is not set
-# CONFIG_CXL_AFU_DRIVER_OPS is not set
-
-#
-# SCSI device support
-#
-CONFIG_SCSI_MOD=y
-# CONFIG_RAID_ATTRS is not set
-CONFIG_SCSI=y
-CONFIG_SCSI_DMA=y
-# CONFIG_SCSI_NETLINK is not set
-# CONFIG_SCSI_MQ_DEFAULT is not set
-CONFIG_SCSI_PROC_FS=y
-
-#
-# SCSI support type (disk, tape, CD-ROM)
-#
-CONFIG_BLK_DEV_SD=y
-# CONFIG_CHR_DEV_ST is not set
-# CONFIG_CHR_DEV_OSST is not set
-# CONFIG_BLK_DEV_SR is not set
-# CONFIG_CHR_DEV_SG is not set
-# CONFIG_CHR_DEV_SCH is not set
-# CONFIG_SCSI_CONSTANTS is not set
-# CONFIG_SCSI_LOGGING is not set
-# CONFIG_SCSI_SCAN_ASYNC is not set
-
-#
-# SCSI Transports
-#
-# CONFIG_SCSI_SPI_ATTRS is not set
-# CONFIG_SCSI_FC_ATTRS is not set
-# CONFIG_SCSI_ISCSI_ATTRS is not set
-# CONFIG_SCSI_SAS_ATTRS is not set
-# CONFIG_SCSI_SAS_LIBSAS is not set
-# CONFIG_SCSI_SRP_ATTRS is not set
-CONFIG_SCSI_LOWLEVEL=y
-# CONFIG_ISCSI_TCP is not set
-# CONFIG_ISCSI_BOOT_SYSFS is not set
-# CONFIG_SCSI_UFSHCD is not set
-# CONFIG_SCSI_DEBUG is not set
-# CONFIG_SCSI_DH is not set
-# CONFIG_SCSI_OSD_INITIATOR is not set
-# CONFIG_ATA is not set
-# CONFIG_MD is not set
-# CONFIG_TARGET_CORE is not set
-CONFIG_NETDEVICES=y
-CONFIG_MII=y
-CONFIG_NET_CORE=y
-# CONFIG_BONDING is not set
-# CONFIG_DUMMY is not set
-# CONFIG_EQUALIZER is not set
-# CONFIG_NET_TEAM is not set
-# CONFIG_MACVLAN is not set
-# CONFIG_VXLAN is not set
-# CONFIG_MACSEC is not set
-# CONFIG_NETCONSOLE is not set
-# CONFIG_NETPOLL is not set
-# CONFIG_NET_POLL_CONTROLLER is not set
-CONFIG_TUN=m
-# CONFIG_TUN_VNET_CROSS_LE is not set
-# CONFIG_VETH is not set
-# CONFIG_NLMON is not set
-
-#
-# CAIF transport drivers
-#
-
-#
-# Distributed Switch Architecture drivers
-#
-# CONFIG_ETHERNET is not set
-CONFIG_PHYLIB=y
-CONFIG_SWPHY=y
-
-#
-# MDIO bus device drivers
-#
-# CONFIG_MDIO_BCM_UNIMAC is not set
-# CONFIG_MDIO_BITBANG is not set
-# CONFIG_MDIO_BUS_MUX_GPIO is not set
-# CONFIG_MDIO_BUS_MUX_MMIOREG is not set
-# CONFIG_MDIO_HISI_FEMAC is not set
-
-#
-# MII PHY device drivers
-#
-# CONFIG_AMD_PHY is not set
-# CONFIG_AQUANTIA_PHY is not set
-# CONFIG_AT803X_PHY is not set
-# CONFIG_BCM7XXX_PHY is not set
-# CONFIG_BCM87XX_PHY is not set
-# CONFIG_BROADCOM_PHY is not set
-# CONFIG_CICADA_PHY is not set
-# CONFIG_DAVICOM_PHY is not set
-# CONFIG_DP83848_PHY is not set
-# CONFIG_DP83867_PHY is not set
-CONFIG_FIXED_PHY=y
-# CONFIG_ICPLUS_PHY is not set
-# CONFIG_INTEL_XWAY_PHY is not set
-# CONFIG_LSI_ET1011C_PHY is not set
-# CONFIG_LXT_PHY is not set
-# CONFIG_MARVELL_PHY is not set
-# CONFIG_MICREL_PHY is not set
-# CONFIG_MICROCHIP_PHY is not set
-# CONFIG_MICROSEMI_PHY is not set
-# CONFIG_NATIONAL_PHY is not set
-# CONFIG_QSEMI_PHY is not set
-# CONFIG_REALTEK_PHY is not set
-# CONFIG_SMSC_PHY is not set
-# CONFIG_STE10XP is not set
-# CONFIG_TERANETICS_PHY is not set
-# CONFIG_VITESSE_PHY is not set
-# CONFIG_XILINX_GMII2RGMII is not set
-# CONFIG_MICREL_KS8995MA is not set
-# CONFIG_PPP is not set
-# CONFIG_SLIP is not set
-
-#
-# Host-side USB support is needed for USB Network Adapter support
-#
-CONFIG_USB_NET_DRIVERS=m
-# CONFIG_USB_CATC is not set
-# CONFIG_USB_KAWETH is not set
-# CONFIG_USB_PEGASUS is not set
-# CONFIG_USB_RTL8150 is not set
-# CONFIG_USB_RTL8152 is not set
-# CONFIG_USB_LAN78XX is not set
-CONFIG_USB_USBNET=m
-CONFIG_USB_NET_AX8817X=m
-CONFIG_USB_NET_AX88179_178A=m
-CONFIG_USB_NET_CDCETHER=m
-# CONFIG_USB_NET_CDC_EEM is not set
-CONFIG_USB_NET_CDC_NCM=m
-# CONFIG_USB_NET_HUAWEI_CDC_NCM is not set
-# CONFIG_USB_NET_CDC_MBIM is not set
-# CONFIG_USB_NET_DM9601 is not set
-# CONFIG_USB_NET_SR9700 is not set
-# CONFIG_USB_NET_SR9800 is not set
-# CONFIG_USB_NET_SMSC75XX is not set
-# CONFIG_USB_NET_SMSC95XX is not set
-# CONFIG_USB_NET_GL620A is not set
-CONFIG_USB_NET_NET1080=m
-# CONFIG_USB_NET_PLUSB is not set
-# CONFIG_USB_NET_MCS7830 is not set
-CONFIG_USB_NET_RNDIS_HOST=m
-CONFIG_USB_NET_CDC_SUBSET_ENABLE=m
-CONFIG_USB_NET_CDC_SUBSET=m
-# CONFIG_USB_ALI_M5632 is not set
-# CONFIG_USB_AN2720 is not set
-# CONFIG_USB_BELKIN is not set
-CONFIG_USB_ARMLINUX=y
-# CONFIG_USB_EPSON2888 is not set
-# CONFIG_USB_KC2190 is not set
-CONFIG_USB_NET_ZAURUS=m
-# CONFIG_USB_NET_CX82310_ETH is not set
-# CONFIG_USB_NET_KALMIA is not set
-# CONFIG_USB_NET_QMI_WWAN is not set
-# CONFIG_USB_NET_INT51X1 is not set
-# CONFIG_USB_IPHETH is not set
-# CONFIG_USB_SIERRA_NET is not set
-# CONFIG_USB_VL600 is not set
-# CONFIG_USB_NET_CH9200 is not set
-CONFIG_WLAN=y
-# CONFIG_WLAN_VENDOR_ADMTEK is not set
-# CONFIG_WLAN_VENDOR_ATH is not set
-# CONFIG_WLAN_VENDOR_ATMEL is not set
-# CONFIG_WLAN_VENDOR_BROADCOM is not set
-# CONFIG_WLAN_VENDOR_CISCO is not set
-# CONFIG_WLAN_VENDOR_INTEL is not set
-# CONFIG_WLAN_VENDOR_INTERSIL is not set
-# CONFIG_WLAN_VENDOR_MARVELL is not set
-CONFIG_WLAN_VENDOR_MEDIATEK=y
-# CONFIG_MT7601U is not set
-CONFIG_WLAN_VENDOR_RALINK=y
-# CONFIG_RT2X00 is not set
-CONFIG_WLAN_VENDOR_REALTEK=y
-# CONFIG_RTL8187 is not set
-# CONFIG_RTL_CARDS is not set
-CONFIG_RTL8XXXU=m
-CONFIG_RTL8XXXU_UNTESTED=y
-# CONFIG_WLAN_VENDOR_RSI is not set
-# CONFIG_WLAN_VENDOR_ST is not set
-# CONFIG_WLAN_VENDOR_TI is not set
-# CONFIG_WLAN_VENDOR_ZYDAS is not set
-# CONFIG_MAC80211_HWSIM is not set
-CONFIG_USB_NET_RNDIS_WLAN=m
-
-#
-# Enable WiMAX (Networking options) to see the WiMAX drivers
-#
-# CONFIG_WAN is not set
-# CONFIG_ISDN is not set
-# CONFIG_NVM is not set
-
-#
-# Input device support
-#
-# CONFIG_INPUT is not set
-
-#
-# Hardware I/O ports
-#
-# CONFIG_SERIO is not set
-# CONFIG_GAMEPORT is not set
-
-#
-# Character devices
-#
-CONFIG_TTY=y
-# CONFIG_VT is not set
-CONFIG_UNIX98_PTYS=y
-# CONFIG_LEGACY_PTYS is not set
-# CONFIG_SERIAL_NONSTANDARD is not set
-# CONFIG_N_GSM is not set
-# CONFIG_TRACE_SINK is not set
-CONFIG_DEVMEM=y
-# CONFIG_DEVKMEM is not set
-
-#
-# Serial drivers
-#
-# CONFIG_SERIAL_8250 is not set
-
-#
-# Non-8250 serial port support
-#
-# CONFIG_SERIAL_EARLYCON_ARM_SEMIHOST is not set
-# CONFIG_SERIAL_MAX3100 is not set
-# CONFIG_SERIAL_MAX310X is not set
-# CONFIG_SERIAL_UARTLITE is not set
-CONFIG_SERIAL_CORE=y
-CONFIG_SERIAL_CORE_CONSOLE=y
-# CONFIG_SERIAL_SCCNXP is not set
-# CONFIG_SERIAL_SC16IS7XX is not set
-# CONFIG_SERIAL_BCM63XX is not set
-# CONFIG_SERIAL_ALTERA_JTAGUART is not set
-# CONFIG_SERIAL_ALTERA_UART is not set
-# CONFIG_SERIAL_IFX6X60 is not set
-# CONFIG_SERIAL_XILINX_PS_UART is not set
-# CONFIG_SERIAL_ARC is not set
-# CONFIG_SERIAL_FSL_LPUART is not set
-# CONFIG_SERIAL_CONEXANT_DIGICOLOR is not set
-# CONFIG_SERIAL_ST_ASC is not set
-# CONFIG_SERIAL_STM32 is not set
-# CONFIG_TTY_PRINTK is not set
-# CONFIG_HVC_DCC is not set
-# CONFIG_IPMI_HANDLER is not set
-# CONFIG_HW_RANDOM is not set
-# CONFIG_R3964 is not set
-# CONFIG_RAW_DRIVER is not set
-# CONFIG_TCG_TPM is not set
-# CONFIG_XILLYBUS is not set
-
-#
-# I2C support
-#
-CONFIG_I2C=y
-CONFIG_I2C_BOARDINFO=y
-# CONFIG_I2C_COMPAT is not set
-CONFIG_I2C_CHARDEV=y
-# CONFIG_I2C_MUX is not set
-# CONFIG_I2C_HELPER_AUTO is not set
-# CONFIG_I2C_SMBUS is not set
-
-#
-# I2C Algorithms
-#
-# CONFIG_I2C_ALGOBIT is not set
-# CONFIG_I2C_ALGOPCF is not set
-# CONFIG_I2C_ALGOPCA is not set
-
-#
-# I2C Hardware Bus support
-#
-
-#
-# I2C system bus drivers (mostly embedded / system-on-chip)
-#
-# CONFIG_I2C_CBUS_GPIO is not set
-# CONFIG_I2C_DESIGNWARE_PLATFORM is not set
-# CONFIG_I2C_EMEV2 is not set
-# CONFIG_I2C_GPIO is not set
-# CONFIG_I2C_OCORES is not set
-# CONFIG_I2C_PCA_PLATFORM is not set
-# CONFIG_I2C_PXA_PCI is not set
-# CONFIG_I2C_RK3X is not set
-# CONFIG_I2C_SIMTEC is not set
-# CONFIG_I2C_XILINX is not set
-
-#
-# External I2C/SMBus adapter drivers
-#
-# CONFIG_I2C_DIOLAN_U2C is not set
-# CONFIG_I2C_PARPORT_LIGHT is not set
-# CONFIG_I2C_ROBOTFUZZ_OSIF is not set
-# CONFIG_I2C_TAOS_EVM is not set
-CONFIG_I2C_TINY_USB=m
-
-#
-# Other I2C/SMBus bus drivers
-#
-# CONFIG_I2C_STUB is not set
-# CONFIG_I2C_SLAVE is not set
-# CONFIG_I2C_DEBUG_CORE is not set
-# CONFIG_I2C_DEBUG_ALGO is not set
-# CONFIG_I2C_DEBUG_BUS is not set
-CONFIG_SPI=y
-# CONFIG_SPI_DEBUG is not set
-CONFIG_SPI_MASTER=y
-
-#
-# SPI Master Controller Drivers
-#
-# CONFIG_SPI_ALTERA is not set
-# CONFIG_SPI_AXI_SPI_ENGINE is not set
-# CONFIG_SPI_BITBANG is not set
-# CONFIG_SPI_CADENCE is not set
-# CONFIG_SPI_DESIGNWARE is not set
-# CONFIG_SPI_GPIO is not set
-# CONFIG_SPI_FSL_SPI is not set
-# CONFIG_SPI_OC_TINY is not set
-# CONFIG_SPI_PXA2XX_PCI is not set
-# CONFIG_SPI_ROCKCHIP is not set
-# CONFIG_SPI_SC18IS602 is not set
-# CONFIG_SPI_XCOMM is not set
-# CONFIG_SPI_XILINX is not set
-# CONFIG_SPI_ZYNQMP_GQSPI is not set
-
-#
-# SPI Protocol Masters
-#
-# CONFIG_SPI_SPIDEV is not set
-# CONFIG_SPI_LOOPBACK_TEST is not set
-# CONFIG_SPI_TLE62X0 is not set
-# CONFIG_SPMI is not set
-# CONFIG_HSI is not set
-
-#
-# PPS support
-#
-# CONFIG_PPS is not set
-
-#
-# PPS generators support
-#
-
-#
-# PTP clock support
-#
-# CONFIG_PTP_1588_CLOCK is not set
-
-#
-# Enable PHYLIB and NETWORK_PHY_TIMESTAMPING to see the additional clocks.
-#
-CONFIG_ARCH_HAVE_CUSTOM_GPIO_H=y
-CONFIG_GPIOLIB=y
-CONFIG_OF_GPIO=y
-# CONFIG_DEBUG_GPIO is not set
-CONFIG_GPIO_SYSFS=y
-
-#
-# Memory mapped GPIO drivers
-#
-# CONFIG_GPIO_74XX_MMIO is not set
-# CONFIG_GPIO_ALTERA is not set
-# CONFIG_GPIO_DWAPB is not set
-# CONFIG_GPIO_EM is not set
-# CONFIG_GPIO_GENERIC_PLATFORM is not set
-# CONFIG_GPIO_GRGPIO is not set
-# CONFIG_GPIO_MOCKUP is not set
-# CONFIG_GPIO_MPC8XXX is not set
-# CONFIG_GPIO_XILINX is not set
-# CONFIG_GPIO_ZEVIO is not set
-# CONFIG_GPIO_ZX is not set
-
-#
-# I2C GPIO expanders
-#
-# CONFIG_GPIO_ADP5588 is not set
-# CONFIG_GPIO_ADNP is not set
-# CONFIG_GPIO_MAX7300 is not set
-# CONFIG_GPIO_MAX732X is not set
-# CONFIG_GPIO_PCA953X is not set
-# CONFIG_GPIO_PCF857X is not set
-# CONFIG_GPIO_SX150X is not set
-# CONFIG_GPIO_TPIC2810 is not set
-# CONFIG_GPIO_TS4900 is not set
-
-#
-# MFD GPIO expanders
-#
-# CONFIG_HTC_EGPIO is not set
-
-#
-# SPI GPIO expanders
-#
-# CONFIG_GPIO_74X164 is not set
-# CONFIG_GPIO_MAX7301 is not set
-# CONFIG_GPIO_MC33880 is not set
-# CONFIG_GPIO_PISOSR is not set
-
-#
-# SPI or I2C GPIO expanders
-#
-# CONFIG_GPIO_MCP23S08 is not set
-
-#
-# USB GPIO expanders
-#
-# CONFIG_W1 is not set
-# CONFIG_POWER_AVS is not set
-# CONFIG_POWER_RESET is not set
-# CONFIG_POWER_SUPPLY is not set
-# CONFIG_HWMON is not set
-# CONFIG_THERMAL is not set
-CONFIG_WATCHDOG=y
-CONFIG_WATCHDOG_CORE=y
-# CONFIG_WATCHDOG_NOWAYOUT is not set
-# CONFIG_WATCHDOG_SYSFS is not set
-
-#
-# Watchdog Device Drivers
-#
-# CONFIG_SOFT_WATCHDOG is not set
-# CONFIG_GPIO_WATCHDOG is not set
-# CONFIG_XILINX_WATCHDOG is not set
-# CONFIG_ZIIRAVE_WATCHDOG is not set
-# CONFIG_CADENCE_WATCHDOG is not set
-# CONFIG_DW_WATCHDOG is not set
-# CONFIG_MAX63XX_WATCHDOG is not set
-# CONFIG_MEN_A21_WDT is not set
-
-#
-# USB-based Watchdog Cards
-#
-# CONFIG_USBPCWATCHDOG is not set
-
-#
-# Watchdog Pretimeout Governors
-#
-# CONFIG_WATCHDOG_PRETIMEOUT_GOV is not set
-CONFIG_SSB_POSSIBLE=y
-
-#
-# Sonics Silicon Backplane
-#
-# CONFIG_SSB is not set
-CONFIG_BCMA_POSSIBLE=y
-
-#
-# Broadcom specific AMBA
-#
-# CONFIG_BCMA is not set
-
-#
-# Multifunction device drivers
-#
-# CONFIG_MFD_CORE is not set
-# CONFIG_MFD_ACT8945A is not set
-# CONFIG_MFD_AS3711 is not set
-# CONFIG_MFD_AS3722 is not set
-# CONFIG_PMIC_ADP5520 is not set
-# CONFIG_MFD_AAT2870_CORE is not set
-# CONFIG_MFD_ATMEL_FLEXCOM is not set
-# CONFIG_MFD_ATMEL_HLCDC is not set
-# CONFIG_MFD_BCM590XX is not set
-# CONFIG_MFD_AXP20X_I2C is not set
-# CONFIG_MFD_CROS_EC is not set
-# CONFIG_MFD_ASIC3 is not set
-# CONFIG_PMIC_DA903X is not set
-# CONFIG_MFD_DA9052_SPI is not set
-# CONFIG_MFD_DA9052_I2C is not set
-# CONFIG_MFD_DA9055 is not set
-# CONFIG_MFD_DA9062 is not set
-# CONFIG_MFD_DA9063 is not set
-# CONFIG_MFD_DA9150 is not set
-# CONFIG_MFD_DLN2 is not set
-# CONFIG_MFD_EXYNOS_LPASS is not set
-# CONFIG_MFD_MC13XXX_SPI is not set
-# CONFIG_MFD_MC13XXX_I2C is not set
-# CONFIG_MFD_HI6421_PMIC is not set
-# CONFIG_HTC_PASIC3 is not set
-# CONFIG_HTC_I2CPLD is not set
-# CONFIG_INTEL_SOC_PMIC is not set
-# CONFIG_MFD_KEMPLD is not set
-# CONFIG_MFD_88PM800 is not set
-# CONFIG_MFD_88PM805 is not set
-# CONFIG_MFD_88PM860X is not set
-# CONFIG_MFD_MAX14577 is not set
-# CONFIG_MFD_MAX77620 is not set
-# CONFIG_MFD_MAX77686 is not set
-# CONFIG_MFD_MAX77693 is not set
-# CONFIG_MFD_MAX77843 is not set
-# CONFIG_MFD_MAX8907 is not set
-# CONFIG_MFD_MAX8925 is not set
-# CONFIG_MFD_MAX8997 is not set
-# CONFIG_MFD_MAX8998 is not set
-# CONFIG_MFD_MT6397 is not set
-# CONFIG_MFD_MENF21BMC is not set
-# CONFIG_EZX_PCAP is not set
-# CONFIG_MFD_VIPERBOARD is not set
-# CONFIG_MFD_RETU is not set
-# CONFIG_MFD_PCF50633 is not set
-# CONFIG_MFD_PM8921_CORE is not set
-# CONFIG_MFD_RT5033 is not set
-# CONFIG_MFD_RTSX_USB is not set
-# CONFIG_MFD_RC5T583 is not set
-# CONFIG_MFD_RK808 is not set
-# CONFIG_MFD_RN5T618 is not set
-# CONFIG_MFD_SEC_CORE is not set
-# CONFIG_MFD_SI476X_CORE is not set
-# CONFIG_MFD_SM501 is not set
-# CONFIG_MFD_SKY81452 is not set
-# CONFIG_MFD_SMSC is not set
-# CONFIG_ABX500_CORE is not set
-# CONFIG_MFD_STMPE is not set
-# CONFIG_MFD_SYSCON is not set
-# CONFIG_MFD_TI_AM335X_TSCADC is not set
-# CONFIG_MFD_LP3943 is not set
-# CONFIG_MFD_LP8788 is not set
-# CONFIG_MFD_PALMAS is not set
-# CONFIG_TPS6105X is not set
-# CONFIG_TPS65010 is not set
-# CONFIG_TPS6507X is not set
-# CONFIG_MFD_TPS65086 is not set
-# CONFIG_MFD_TPS65090 is not set
-# CONFIG_MFD_TPS65217 is not set
-# CONFIG_MFD_TI_LP873X is not set
-# CONFIG_MFD_TPS65218 is not set
-# CONFIG_MFD_TPS6586X is not set
-# CONFIG_MFD_TPS65910 is not set
-# CONFIG_MFD_TPS65912_I2C is not set
-# CONFIG_MFD_TPS65912_SPI is not set
-# CONFIG_MFD_TPS80031 is not set
-# CONFIG_TWL4030_CORE is not set
-# CONFIG_TWL6040_CORE is not set
-# CONFIG_MFD_WL1273_CORE is not set
-# CONFIG_MFD_LM3533 is not set
-# CONFIG_MFD_TC3589X is not set
-# CONFIG_MFD_TMIO is not set
-# CONFIG_MFD_T7L66XB is not set
-# CONFIG_MFD_TC6387XB is not set
-# CONFIG_MFD_TC6393XB is not set
-# CONFIG_MFD_ARIZONA_I2C is not set
-# CONFIG_MFD_ARIZONA_SPI is not set
-# CONFIG_MFD_WM8400 is not set
-# CONFIG_MFD_WM831X_I2C is not set
-# CONFIG_MFD_WM831X_SPI is not set
-# CONFIG_MFD_WM8350_I2C is not set
-# CONFIG_MFD_WM8994 is not set
-# CONFIG_REGULATOR is not set
-# CONFIG_MEDIA_SUPPORT is not set
-
-#
-# Graphics support
-#
-# CONFIG_DRM is not set
-
-#
-# ACP (Audio CoProcessor) Configuration
-#
-
-#
-# Frame buffer Devices
-#
-CONFIG_FB=y
-# CONFIG_FIRMWARE_EDID is not set
-CONFIG_FB_CMDLINE=y
-CONFIG_FB_NOTIFY=y
-# CONFIG_FB_DDC is not set
-# CONFIG_FB_BOOT_VESA_SUPPORT is not set
-# CONFIG_FB_CFB_FILLRECT is not set
-# CONFIG_FB_CFB_COPYAREA is not set
-# CONFIG_FB_CFB_IMAGEBLIT is not set
-# CONFIG_FB_CFB_REV_PIXELS_IN_BYTE is not set
-# CONFIG_FB_SYS_FILLRECT is not set
-# CONFIG_FB_SYS_COPYAREA is not set
-# CONFIG_FB_SYS_IMAGEBLIT is not set
-# CONFIG_FB_FOREIGN_ENDIAN is not set
-# CONFIG_FB_SYS_FOPS is not set
-# CONFIG_FB_SVGALIB is not set
-# CONFIG_FB_MACMODES is not set
-# CONFIG_FB_BACKLIGHT is not set
-# CONFIG_FB_MODE_HELPERS is not set
-# CONFIG_FB_TILEBLITTING is not set
-
-#
-# Frame buffer hardware drivers
-#
-# CONFIG_FB_OPENCORES is not set
-# CONFIG_FB_S1D13XXX is not set
-# CONFIG_FB_SMSCUFX is not set
-# CONFIG_FB_UDL is not set
-# CONFIG_FB_IBM_GXT4500 is not set
-# CONFIG_FB_VIRTUAL is not set
-# CONFIG_FB_METRONOME is not set
-# CONFIG_FB_BROADSHEET is not set
-# CONFIG_FB_AUO_K190X is not set
-# CONFIG_FB_SIMPLE is not set
-# CONFIG_FB_SSD1307 is not set
-# CONFIG_BACKLIGHT_LCD_SUPPORT is not set
-# CONFIG_VGASTATE is not set
-# CONFIG_LOGO is not set
-# CONFIG_SOUND is not set
-CONFIG_USB_OHCI_LITTLE_ENDIAN=y
-CONFIG_USB_SUPPORT=y
-CONFIG_MP_USB_MSTAR=y
-CONFIG_USB_COMMON=y
-CONFIG_USB_ARCH_HAS_HCD=y
-CONFIG_USB=y
-CONFIG_USB_ANNOUNCE_NEW_DEVICES=y
-
-#
-# Miscellaneous USB options
-#
-CONFIG_USB_DEFAULT_PERSIST=y
-# CONFIG_USB_DYNAMIC_MINORS is not set
-# CONFIG_USB_OTG_WHITELIST is not set
-# CONFIG_USB_OTG_BLACKLIST_HUB is not set
-# CONFIG_USB_MON is not set
-# CONFIG_USB_WUSB_CBAF is not set
-
-#
-# USB Host Controller Drivers
-#
-# CONFIG_USB_C67X00_HCD is not set
-# CONFIG_USB_XHCI_HCD is not set
-CONFIG_USB_EHCI_HCD=y
-CONFIG_USB_EHCI_ROOT_HUB_TT=y
-CONFIG_USB_EHCI_TT_NEWSCHED=y
-# CONFIG_USB_EHCI_SUSPEND_PORT is not set
-# CONFIG_USB_EHCI_HCD_PLATFORM is not set
-# CONFIG_USB_OXU210HP_HCD is not set
-# CONFIG_USB_ISP116X_HCD is not set
-# CONFIG_USB_ISP1362_HCD is not set
-# CONFIG_USB_FOTG210_HCD is not set
-# CONFIG_USB_MAX3421_HCD is not set
-# CONFIG_USB_OHCI_HCD is not set
-# CONFIG_USB_SL811_HCD is not set
-# CONFIG_USB_R8A66597_HCD is not set
-# CONFIG_USB_HCD_TEST_MODE is not set
-
-#
-# USB Device Class drivers
-#
-# CONFIG_USB_ACM is not set
-# CONFIG_USB_PRINTER is not set
-# CONFIG_USB_WDM is not set
-# CONFIG_USB_TMC is not set
-
-#
-# NOTE: USB_STORAGE depends on SCSI but BLK_DEV_SD may
-#
-
-#
-# also be needed; see USB_STORAGE Help for more info
-#
-CONFIG_USB_STORAGE=m
-# CONFIG_USB_STORAGE_DEBUG is not set
-# CONFIG_USB_STORAGE_REALTEK is not set
-# CONFIG_USB_STORAGE_DATAFAB is not set
-# CONFIG_USB_STORAGE_FREECOM is not set
-# CONFIG_USB_STORAGE_ISD200 is not set
-# CONFIG_USB_STORAGE_USBAT is not set
-# CONFIG_USB_STORAGE_SDDR09 is not set
-# CONFIG_USB_STORAGE_SDDR55 is not set
-# CONFIG_USB_STORAGE_JUMPSHOT is not set
-# CONFIG_USB_STORAGE_ALAUDA is not set
-# CONFIG_USB_STORAGE_KARMA is not set
-# CONFIG_USB_STORAGE_CYPRESS_ATACB is not set
-# CONFIG_USB_STORAGE_ENE_UB6250 is not set
-# CONFIG_USB_UAS is not set
-
-#
-# USB Imaging devices
-#
-# CONFIG_USB_MDC800 is not set
-# CONFIG_USB_MICROTEK is not set
-# CONFIG_USBIP_CORE is not set
-# CONFIG_USB_MUSB_HDRC is not set
-# CONFIG_USB_DWC3 is not set
-# CONFIG_USB_DWC2 is not set
-# CONFIG_USB_CHIPIDEA is not set
-# CONFIG_USB_ISP1760 is not set
-
-#
-# USB port drivers
-#
-# CONFIG_USB_SERIAL is not set
-
-#
-# USB Miscellaneous drivers
-#
-# CONFIG_USB_EMI62 is not set
-# CONFIG_USB_EMI26 is not set
-# CONFIG_USB_ADUTUX is not set
-# CONFIG_USB_SEVSEG is not set
-# CONFIG_USB_RIO500 is not set
-# CONFIG_USB_LEGOTOWER is not set
-# CONFIG_USB_LCD is not set
-# CONFIG_USB_CYPRESS_CY7C63 is not set
-# CONFIG_USB_CYTHERM is not set
-# CONFIG_USB_IDMOUSE is not set
-# CONFIG_USB_FTDI_ELAN is not set
-# CONFIG_USB_APPLEDISPLAY is not set
-# CONFIG_USB_SISUSBVGA is not set
-# CONFIG_USB_LD is not set
-# CONFIG_USB_TRANCEVIBRATOR is not set
-# CONFIG_USB_IOWARRIOR is not set
-# CONFIG_USB_TEST is not set
-# CONFIG_USB_EHSET_TEST_FIXTURE is not set
-# CONFIG_USB_ISIGHTFW is not set
-# CONFIG_USB_YUREX is not set
-# CONFIG_USB_EZUSB_FX2 is not set
-# CONFIG_USB_HSIC_USB3503 is not set
-# CONFIG_USB_HSIC_USB4604 is not set
-# CONFIG_USB_LINK_LAYER_TEST is not set
-
-#
-# USB Physical Layer drivers
-#
-# CONFIG_USB_PHY is not set
-# CONFIG_NOP_USB_XCEIV is not set
-# CONFIG_USB_GPIO_VBUS is not set
-# CONFIG_USB_ISP1301 is not set
-# CONFIG_USB_ULPI is not set
-# CONFIG_USB_GADGET is not set
-# CONFIG_USB_ULPI_BUS is not set
-# CONFIG_UWB is not set
-CONFIG_MMC=y
-CONFIG_SS_FAST_MMC=y
-# CONFIG_MMC_DEBUG is not set
-CONFIG_PWRSEQ_EMMC=y
-CONFIG_PWRSEQ_SIMPLE=y
-
-#
-# MMC/SD/SDIO Card Drivers
-#
-CONFIG_MMC_BLOCK=y
-CONFIG_MMC_BLOCK_MINORS=8
-CONFIG_MMC_BLOCK_BOUNCE=y
-# CONFIG_SDIO_UART is not set
-# CONFIG_MMC_TEST is not set
-
-#
-# MMC/SD/SDIO Host Controller Drivers
-#
-# CONFIG_MMC_SDHCI is not set
-# CONFIG_MMC_SPI is not set
-# CONFIG_MMC_DW is not set
-# CONFIG_MMC_VUB300 is not set
-# CONFIG_MMC_USHC is not set
-# CONFIG_MMC_USDHI6ROL0 is not set
-# CONFIG_MMC_MTK is not set
-# CONFIG_MEMSTICK is not set
-# CONFIG_NEW_LEDS is not set
-# CONFIG_ACCESSIBILITY is not set
-CONFIG_EDAC_ATOMIC_SCRUB=y
-CONFIG_EDAC_SUPPORT=y
-# CONFIG_EDAC is not set
-CONFIG_RTC_LIB=y
-CONFIG_RTC_CLASS=y
-CONFIG_RTC_HCTOSYS=y
-CONFIG_RTC_HCTOSYS_DEVICE="rtc0"
-CONFIG_RTC_SYSTOHC=y
-CONFIG_RTC_SYSTOHC_DEVICE="rtc0"
-# CONFIG_RTC_DEBUG is not set
-
-#
-# RTC interfaces
-#
-CONFIG_RTC_INTF_SYSFS=y
-CONFIG_RTC_INTF_PROC=y
-CONFIG_RTC_INTF_DEV=y
-# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set
-# CONFIG_RTC_DRV_TEST is not set
-
-#
-# I2C RTC drivers
-#
-# CONFIG_RTC_DRV_ABB5ZES3 is not set
-# CONFIG_RTC_DRV_ABX80X is not set
-# CONFIG_RTC_DRV_DS1307 is not set
-# CONFIG_RTC_DRV_DS1374 is not set
-# CONFIG_RTC_DRV_DS1672 is not set
-# CONFIG_RTC_DRV_HYM8563 is not set
-# CONFIG_RTC_DRV_MAX6900 is not set
-# CONFIG_RTC_DRV_RS5C372 is not set
-# CONFIG_RTC_DRV_ISL1208 is not set
-# CONFIG_RTC_DRV_ISL12022 is not set
-# CONFIG_RTC_DRV_X1205 is not set
-# CONFIG_RTC_DRV_PCF8523 is not set
-# CONFIG_RTC_DRV_PCF85063 is not set
-# CONFIG_RTC_DRV_PCF8563 is not set
-# CONFIG_RTC_DRV_PCF8583 is not set
-# CONFIG_RTC_DRV_M41T80 is not set
-# CONFIG_RTC_DRV_BQ32K is not set
-# CONFIG_RTC_DRV_S35390A is not set
-# CONFIG_RTC_DRV_FM3130 is not set
-# CONFIG_RTC_DRV_RX8010 is not set
-# CONFIG_RTC_DRV_RX8581 is not set
-# CONFIG_RTC_DRV_RX8025 is not set
-# CONFIG_RTC_DRV_EM3027 is not set
-# CONFIG_RTC_DRV_RV8803 is not set
-
-#
-# SPI RTC drivers
-#
-# CONFIG_RTC_DRV_M41T93 is not set
-# CONFIG_RTC_DRV_M41T94 is not set
-# CONFIG_RTC_DRV_DS1302 is not set
-# CONFIG_RTC_DRV_DS1305 is not set
-# CONFIG_RTC_DRV_DS1343 is not set
-# CONFIG_RTC_DRV_DS1347 is not set
-# CONFIG_RTC_DRV_DS1390 is not set
-# CONFIG_RTC_DRV_MAX6916 is not set
-# CONFIG_RTC_DRV_R9701 is not set
-# CONFIG_RTC_DRV_RX4581 is not set
-# CONFIG_RTC_DRV_RX6110 is not set
-# CONFIG_RTC_DRV_RS5C348 is not set
-# CONFIG_RTC_DRV_MAX6902 is not set
-# CONFIG_RTC_DRV_PCF2123 is not set
-# CONFIG_RTC_DRV_MCP795 is not set
-CONFIG_RTC_I2C_AND_SPI=y
-
-#
-# SPI and I2C RTC drivers
-#
-# CONFIG_RTC_DRV_DS3232 is not set
-# CONFIG_RTC_DRV_PCF2127 is not set
-# CONFIG_RTC_DRV_RV3029C2 is not set
-
-#
-# Platform RTC drivers
-#
-# CONFIG_RTC_DRV_CMOS is not set
-# CONFIG_RTC_DRV_DS1286 is not set
-# CONFIG_RTC_DRV_DS1511 is not set
-# CONFIG_RTC_DRV_DS1553 is not set
-# CONFIG_RTC_DRV_DS1685_FAMILY is not set
-# CONFIG_RTC_DRV_DS1742 is not set
-# CONFIG_RTC_DRV_DS2404 is not set
-# CONFIG_RTC_DRV_STK17TA8 is not set
-# CONFIG_RTC_DRV_M48T86 is not set
-# CONFIG_RTC_DRV_M48T35 is not set
-# CONFIG_RTC_DRV_M48T59 is not set
-# CONFIG_RTC_DRV_MSM6242 is not set
-# CONFIG_RTC_DRV_BQ4802 is not set
-# CONFIG_RTC_DRV_RP5C01 is not set
-# CONFIG_RTC_DRV_V3020 is not set
-# CONFIG_RTC_DRV_ZYNQMP is not set
-
-#
-# on-CPU RTC drivers
-#
-# CONFIG_RTC_DRV_SNVS is not set
-
-#
-# HID Sensor RTC drivers
-#
-# CONFIG_DMADEVICES is not set
-
-#
-# DMABUF options
-#
-# CONFIG_SYNC_FILE is not set
-# CONFIG_AUXDISPLAY is not set
-CONFIG_UIO=y
-CONFIG_UIO_PDRV_GENIRQ=y
-# CONFIG_UIO_DMEM_GENIRQ is not set
-# CONFIG_UIO_PRUSS is not set
-# CONFIG_VIRT_DRIVERS is not set
-
-#
-# Virtio drivers
-#
-# CONFIG_VIRTIO_MMIO is not set
-
-#
-# Microsoft Hyper-V guest support
-#
-CONFIG_STAGING=y
-# CONFIG_PRISM2_USB is not set
-# CONFIG_COMEDI is not set
-# CONFIG_RTLLIB is not set
-# CONFIG_R8712U is not set
-# CONFIG_R8188EU is not set
-# CONFIG_VT6656 is not set
-
-#
-# Speakup console speech
-#
-# CONFIG_STAGING_MEDIA is not set
-
-#
-# Android
-#
-# CONFIG_ASHMEM is not set
-# CONFIG_ANDROID_LOW_MEMORY_KILLER is not set
-# CONFIG_ION is not set
-# CONFIG_STAGING_BOARD is not set
-# CONFIG_LTE_GDM724X is not set
-# CONFIG_MTD_SPINAND_MT29F is not set
-# CONFIG_LNET is not set
-# CONFIG_GS_FPGABOOT is not set
-# CONFIG_COMMON_CLK_XLNX_CLKWZRD is not set
-# CONFIG_FB_TFT is not set
-# CONFIG_WILC1000_SDIO is not set
-# CONFIG_WILC1000_SPI is not set
-# CONFIG_MOST is not set
-# CONFIG_KS7010 is not set
-# CONFIG_GREYBUS is not set
-# CONFIG_GOLDFISH is not set
-# CONFIG_CHROME_PLATFORMS is not set
-CONFIG_CLKDEV_LOOKUP=y
-CONFIG_HAVE_CLK_PREPARE=y
-CONFIG_COMMON_CLK=y
-
-#
-# Common Clock Framework
-#
-# CONFIG_COMMON_CLK_SI5351 is not set
-# CONFIG_COMMON_CLK_SI514 is not set
-# CONFIG_COMMON_CLK_SI570 is not set
-# CONFIG_COMMON_CLK_CDCE706 is not set
-# CONFIG_COMMON_CLK_CDCE925 is not set
-# CONFIG_COMMON_CLK_CS2000_CP is not set
-# CONFIG_CLK_QORIQ is not set
-# CONFIG_COMMON_CLK_NXP is not set
-# CONFIG_COMMON_CLK_PWM is not set
-# CONFIG_COMMON_CLK_PXA is not set
-# CONFIG_COMMON_CLK_PIC32 is not set
-
-#
-# Hardware Spinlock drivers
-#
-
-#
-# Clock Source drivers
-#
-CONFIG_CLKSRC_OF=y
-CONFIG_CLKSRC_PROBE=y
-CONFIG_ARM_ARCH_TIMER=y
-CONFIG_ARM_ARCH_TIMER_EVTSTREAM=y
-# CONFIG_ARM_TIMER_SP804 is not set
-# CONFIG_ATMEL_PIT is not set
-# CONFIG_SH_TIMER_CMT is not set
-# CONFIG_SH_TIMER_MTU2 is not set
-# CONFIG_SH_TIMER_TMU is not set
-# CONFIG_EM_TIMER_STI is not set
-# CONFIG_MAILBOX is not set
-# CONFIG_IOMMU_SUPPORT is not set
-
-#
-# Remoteproc drivers
-#
-# CONFIG_STE_MODEM_RPROC is not set
-
-#
-# Rpmsg drivers
-#
-
-#
-# SOC (System On Chip) specific Drivers
-#
-
-#
-# Broadcom SoC drivers
-#
-# CONFIG_SOC_BRCMSTB is not set
-# CONFIG_SUNXI_SRAM is not set
-# CONFIG_SOC_TI is not set
-# CONFIG_PM_DEVFREQ is not set
-# CONFIG_EXTCON is not set
-# CONFIG_MEMORY is not set
-# CONFIG_IIO is not set
-CONFIG_PWM=y
-CONFIG_PWM_SYSFS=y
-# CONFIG_PWM_FSL_FTM is not set
-# CONFIG_PWM_PCA9685 is not set
-CONFIG_IRQCHIP=y
-CONFIG_ARM_GIC=y
-CONFIG_ARM_GIC_MAX_NR=1
-# CONFIG_IPACK_BUS is not set
-# CONFIG_RESET_CONTROLLER is not set
-# CONFIG_FMC is not set
-
-#
-# PHY Subsystem
-#
-# CONFIG_GENERIC_PHY is not set
-# CONFIG_PHY_PXA_28NM_HSIC is not set
-# CONFIG_PHY_PXA_28NM_USB2 is not set
-# CONFIG_BCM_KONA_USB2_PHY is not set
-# CONFIG_POWERCAP is not set
-# CONFIG_MCB is not set
-
-#
-# Performance monitor support
-#
-CONFIG_ARM_PMU=y
-# CONFIG_RAS is not set
-
-#
-# Android
-#
-CONFIG_ANDROID=y
-# CONFIG_ANDROID_BINDER_IPC is not set
-CONFIG_NVMEM=m
-# CONFIG_STM is not set
-# CONFIG_INTEL_TH is not set
-
-#
-# FPGA Configuration Support
-#
-# CONFIG_FPGA is not set
-CONFIG_MSTAR_DRIVERS=y
-# CONFIG_CAM_DRIVERS is not set
-# CONFIG_DLA_DRIVER is not set
-# CONFIG_MS_PIU_TIMER is not set
-CONFIG_MS_MSYS=y
-CONFIG_MS_ZEN=y
-# CONFIG_MS_MSYS_LOG is not set
-# CONFIG_MSYS_PERF_TEST is not set
-# CONFIG_MSYS_BENCH_MEMORY_FUNC is not set
-# CONFIG_MSYS_MIU_PROTECT is not set
-# CONFIG_MSYS_DMEM_SYSFS_ALL is not set
-CONFIG_MS_SERIAL=y
-# CONFIG_MS_USCLK is not set
-CONFIG_MS_FLASH_ISP=y
-CONFIG_MS_FLASH_ISP_MXP_PARTS=y
-CONFIG_MS_PWM=y
-# CONFIG_PWM_NEW is not set
-CONFIG_MS_SPINAND=m
-# CONFIG_NAND_SINGLE_READ is not set
-# CONFIG_NAND_DUAL_READ is not set
-# CONFIG_NAND_QUAL_READ is not set
-CONFIG_AUTO_DETECT=y
-# CONFIG_NAND_QUAL_WRITE is not set
-CONFIG_AUTO_DETECT_WRITE=y
-CONFIG_MS_SPI_INFINITY=y
-# CONFIG_SS_MSPI is not set
-# CONFIG_CAM_CLK is not set
-# CONFIG_MS_EMMC is not set
-CONFIG_MS_SDMMC=y
-CONFIG_MS_EMAC=y
-# CONFIG_EMAC_SUPPLY_RNG is not set
-# CONFIG_MSTAR_HW_TX_CHECKSUM is not set
-# CONFIG_K3_RX_SWPATCH is not set
-CONFIG_DISCONNECT_DELAY_S=1
-# CONFIG_MSTAR_EEE is not set
-# CONFIG_EMAC_PHY_RESTART_AN is not set
-# CONFIG_MS_IRCUT is not set
-CONFIG_MS_RTC=y
-# CONFIG_RTC_INNER is not set
-CONFIG_RTCPWC_INNER=y
-# CONFIG_RTCPWC_SW_RST_OFF is not set
-# CONFIG_RTCPWC_INNER_EHHE is not set
-CONFIG_MS_CRYPTO=y
-# CONFIG_SS_AESDMA_INTR is not set
-# CONFIG_SS_RNG is not set
-CONFIG_CRYPTODEV=m
-CONFIG_MS_CPU_FREQ=y
-CONFIG_MS_IVE=y
-CONFIG_MS_NOTIFY=m
-CONFIG_SS_ISP_ISRCB=y
-CONFIG_MSTAR_MIU=y
-CONFIG_SSC007A_S01A=y
-CONFIG_MS_BDMA=y
-# CONFIG_MS_BDMA_LINE_OFFSET_ON is not set
-CONFIG_MS_MOVE_DMA=y
-# CONFIG_MS_IR is not set
-CONFIG_MS_I2C=y
-# CONFIG_MS_I2C_INT_ISR is not set
-CONFIG_MS_GPIO=y
-CONFIG_MS_SW_I2C=y
-CONFIG_MS_PADMUX=y
-CONFIG_MS_WATCHDOG=y
-CONFIG_MS_SAR=y
-# CONFIG_MS_SARKEY is not set
-CONFIG_MSTAR_MMAHEAP=y
-CONFIG_SSTAR_NETPHY=y
-CONFIG_SS_VOLTAGE_CTRL=y
-# CONFIG_SS_SWTOE is not set
-# CONFIG_MS_EMAC_TOE is not set
-
-#
-# Firmware Drivers
-#
-# CONFIG_FIRMWARE_MEMMAP is not set
-# CONFIG_FW_CFG_SYSFS is not set
-CONFIG_HAVE_ARM_SMCCC=y
-
-#
-# File systems
-#
-CONFIG_DCACHE_WORD_ACCESS=y
-# CONFIG_EXT2_FS is not set
-# CONFIG_EXT3_FS is not set
-# CONFIG_EXT4_FS is not set
-# CONFIG_REISERFS_FS is not set
-# CONFIG_JFS_FS is not set
-# CONFIG_OCFS2_FS is not set
-# CONFIG_BTRFS_FS is not set
-# CONFIG_NILFS2_FS is not set
-CONFIG_F2FS_FS=m
-CONFIG_F2FS_STAT_FS=y
-CONFIG_F2FS_FS_XATTR=y
-CONFIG_F2FS_FS_POSIX_ACL=y
-# CONFIG_F2FS_FS_SECURITY is not set
-# CONFIG_F2FS_CHECK_FS is not set
-# CONFIG_F2FS_FS_ENCRYPTION is not set
-# CONFIG_F2FS_FAULT_INJECTION is not set
-CONFIG_FS_POSIX_ACL=y
-# CONFIG_EXPORTFS_BLOCK_OPS is not set
-CONFIG_FILE_LOCKING=y
-CONFIG_MANDATORY_FILE_LOCKING=y
-# CONFIG_FS_ENCRYPTION is not set
-CONFIG_FSNOTIFY=y
-CONFIG_DNOTIFY=y
-CONFIG_INOTIFY_USER=y
-# CONFIG_FANOTIFY is not set
-# CONFIG_QUOTA is not set
-# CONFIG_QUOTACTL is not set
-# CONFIG_AUTOFS4_FS is not set
-# CONFIG_FUSE_FS is not set
-CONFIG_OVERLAY_FS=y
-
-#
-# Caches
-#
-# CONFIG_FSCACHE is not set
-
-#
-# CD-ROM/DVD Filesystems
-#
-# CONFIG_ISO9660_FS is not set
-# CONFIG_UDF_FS is not set
-
-#
-# DOS/FAT/NT Filesystems
-#
-CONFIG_FAT_FS=m
-# CONFIG_MSDOS_FS is not set
-CONFIG_VFAT_FS=m
-CONFIG_FAT_DEFAULT_CODEPAGE=437
-CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1"
-# CONFIG_FAT_DEFAULT_UTF8 is not set
-# CONFIG_NTFS_FS is not set
-
-#
-# Pseudo filesystems
-#
-CONFIG_PROC_FS=y
-CONFIG_PROC_SYSCTL=y
-CONFIG_PROC_PAGE_MONITOR=y
-# CONFIG_PROC_CHILDREN is not set
-CONFIG_KERNFS=y
-CONFIG_SYSFS=y
-CONFIG_TMPFS=y
-CONFIG_TMPFS_POSIX_ACL=y
-CONFIG_TMPFS_XATTR=y
-# CONFIG_HUGETLB_PAGE is not set
-CONFIG_CONFIGFS_FS=y
-CONFIG_MISC_FILESYSTEMS=y
-# CONFIG_ORANGEFS_FS is not set
-# CONFIG_ADFS_FS is not set
-# CONFIG_AFFS_FS is not set
-# CONFIG_HFS_FS is not set
-# CONFIG_HFSPLUS_FS is not set
-# CONFIG_BEFS_FS is not set
-# CONFIG_BFS_FS is not set
-# CONFIG_EFS_FS is not set
-CONFIG_JFFS2_FS=y
-CONFIG_JFFS2_FS_DEBUG=0
-# CONFIG_JFFS2_FS_WRITEBUFFER is not set
-# CONFIG_JFFS2_SUMMARY is not set
-# CONFIG_JFFS2_FS_XATTR is not set
-# CONFIG_JFFS2_COMPRESSION_OPTIONS is not set
-CONFIG_JFFS2_ZLIB=y
-# CONFIG_JFFS2_LZO is not set
-CONFIG_JFFS2_RTIME=y
-# CONFIG_JFFS2_RUBIN is not set
-# CONFIG_UBIFS_FS is not set
-# CONFIG_LOGFS is not set
-# CONFIG_CRAMFS is not set
-CONFIG_SQUASHFS=y
-# CONFIG_SQUASHFS_FILE_CACHE is not set
-CONFIG_SQUASHFS_FILE_DIRECT=y
-CONFIG_SQUASHFS_DECOMP_SINGLE=y
-# CONFIG_SQUASHFS_DECOMP_MULTI is not set
-# CONFIG_SQUASHFS_DECOMP_MULTI_PERCPU is not set
-# CONFIG_SQUASHFS_XATTR is not set
-CONFIG_SQUASHFS_ZLIB=y
-# CONFIG_SQUASHFS_LZ4 is not set
-CONFIG_SQUASHFS_LZO=y
-CONFIG_SQUASHFS_XZ=y
-CONFIG_SQUASHFS_4K_DEVBLK_SIZE=y
-CONFIG_SQUASHFS_EMBEDDED=y
-CONFIG_SQUASHFS_FRAGMENT_CACHE_SIZE=3
-# CONFIG_VXFS_FS is not set
-# CONFIG_MINIX_FS is not set
-# CONFIG_OMFS_FS is not set
-# CONFIG_HPFS_FS is not set
-# CONFIG_QNX4FS_FS is not set
-# CONFIG_QNX6FS_FS is not set
-# CONFIG_ROMFS_FS is not set
-# CONFIG_PSTORE is not set
-# CONFIG_SYSV_FS is not set
-# CONFIG_UFS_FS is not set
-CONFIG_NETWORK_FILESYSTEMS=y
-CONFIG_NFS_FS=y
-# CONFIG_NFS_V2 is not set
-CONFIG_NFS_V3=y
-CONFIG_NFS_V3_ACL=y
-# CONFIG_NFS_V4 is not set
-# CONFIG_NFS_SWAP is not set
-CONFIG_ROOT_NFS=y
-# CONFIG_NFSD is not set
-CONFIG_GRACE_PERIOD=y
-CONFIG_LOCKD=y
-CONFIG_LOCKD_V4=y
-CONFIG_NFS_ACL_SUPPORT=y
-CONFIG_NFS_COMMON=y
-CONFIG_SUNRPC=y
-# CONFIG_SUNRPC_DEBUG is not set
-# CONFIG_CEPH_FS is not set
-# CONFIG_CIFS is not set
-# CONFIG_CIFS_STATS is not set
-# CONFIG_CIFS_WEAK_PW_HASH is not set
-# CONFIG_CIFS_XATTR is not set
-# CONFIG_CIFS_DEBUG is not set
-# CONFIG_CIFS_SMB2 is not set
-# CONFIG_NCP_FS is not set
-# CONFIG_CODA_FS is not set
-# CONFIG_AFS_FS is not set
-CONFIG_NLS=y
-CONFIG_NLS_DEFAULT="iso8859-1"
-CONFIG_NLS_CODEPAGE_437=y
-# CONFIG_NLS_CODEPAGE_737 is not set
-# CONFIG_NLS_CODEPAGE_775 is not set
-# CONFIG_NLS_CODEPAGE_850 is not set
-# CONFIG_NLS_CODEPAGE_852 is not set
-# CONFIG_NLS_CODEPAGE_855 is not set
-# CONFIG_NLS_CODEPAGE_857 is not set
-# CONFIG_NLS_CODEPAGE_860 is not set
-# CONFIG_NLS_CODEPAGE_861 is not set
-# CONFIG_NLS_CODEPAGE_862 is not set
-# CONFIG_NLS_CODEPAGE_863 is not set
-# CONFIG_NLS_CODEPAGE_864 is not set
-# CONFIG_NLS_CODEPAGE_865 is not set
-# CONFIG_NLS_CODEPAGE_866 is not set
-# CONFIG_NLS_CODEPAGE_869 is not set
-# CONFIG_NLS_CODEPAGE_936 is not set
-# CONFIG_NLS_CODEPAGE_950 is not set
-# CONFIG_NLS_CODEPAGE_932 is not set
-# CONFIG_NLS_CODEPAGE_949 is not set
-# CONFIG_NLS_CODEPAGE_874 is not set
-# CONFIG_NLS_ISO8859_8 is not set
-# CONFIG_NLS_CODEPAGE_1250 is not set
-# CONFIG_NLS_CODEPAGE_1251 is not set
-# CONFIG_NLS_ASCII is not set
-CONFIG_NLS_ISO8859_1=y
-# CONFIG_NLS_ISO8859_2 is not set
-# CONFIG_NLS_ISO8859_3 is not set
-# CONFIG_NLS_ISO8859_4 is not set
-# CONFIG_NLS_ISO8859_5 is not set
-# CONFIG_NLS_ISO8859_6 is not set
-# CONFIG_NLS_ISO8859_7 is not set
-# CONFIG_NLS_ISO8859_9 is not set
-# CONFIG_NLS_ISO8859_13 is not set
-# CONFIG_NLS_ISO8859_14 is not set
-# CONFIG_NLS_ISO8859_15 is not set
-# CONFIG_NLS_KOI8_R is not set
-# CONFIG_NLS_KOI8_U is not set
-# CONFIG_NLS_MAC_ROMAN is not set
-# CONFIG_NLS_MAC_CELTIC is not set
-# CONFIG_NLS_MAC_CENTEURO is not set
-# CONFIG_NLS_MAC_CROATIAN is not set
-# CONFIG_NLS_MAC_CYRILLIC is not set
-# CONFIG_NLS_MAC_GAELIC is not set
-# CONFIG_NLS_MAC_GREEK is not set
-# CONFIG_NLS_MAC_ICELAND is not set
-# CONFIG_NLS_MAC_INUIT is not set
-# CONFIG_NLS_MAC_ROMANIAN is not set
-# CONFIG_NLS_MAC_TURKISH is not set
-CONFIG_NLS_UTF8=y
-# CONFIG_DLM is not set
-
-#
-# Kernel hacking
-#
-
-#
-# printk and dmesg options
-#
-# CONFIG_PRINTK_TIME is not set
-CONFIG_MESSAGE_LOGLEVEL_DEFAULT=3
-# CONFIG_BOOT_PRINTK_DELAY is not set
-# CONFIG_DYNAMIC_DEBUG is not set
-
-#
-# Compile-time checks and compiler options
-#
-CONFIG_DEBUG_INFO=y
-# CONFIG_DEBUG_INFO_REDUCED is not set
-# CONFIG_DEBUG_INFO_SPLIT is not set
-# CONFIG_DEBUG_INFO_DWARF4 is not set
-# CONFIG_GDB_SCRIPTS is not set
-CONFIG_ENABLE_WARN_DEPRECATED=y
-CONFIG_ENABLE_MUST_CHECK=y
-CONFIG_FRAME_WARN=4096
-# CONFIG_STRIP_ASM_SYMS is not set
-# CONFIG_READABLE_ASM is not set
-# CONFIG_UNUSED_SYMBOLS is not set
-# CONFIG_PAGE_OWNER is not set
-CONFIG_DEBUG_FS=y
-# CONFIG_HEADERS_CHECK is not set
-# CONFIG_DEBUG_SECTION_MISMATCH is not set
-CONFIG_SECTION_MISMATCH_WARN_ONLY=y
-# CONFIG_DEBUG_FORCE_WEAK_PER_CPU is not set
-CONFIG_MAGIC_SYSRQ=y
-CONFIG_DEBUG_KERNEL=y
-
-#
-# Memory Debugging
-#
-# CONFIG_PAGE_EXTENSION is not set
-# CONFIG_DEBUG_PAGEALLOC is not set
-# CONFIG_PAGE_POISONING is not set
-# CONFIG_DEBUG_OBJECTS is not set
-# CONFIG_SLUB_STATS is not set
-CONFIG_HAVE_DEBUG_KMEMLEAK=y
-# CONFIG_DEBUG_KMEMLEAK is not set
-# CONFIG_DEBUG_STACK_USAGE is not set
-# CONFIG_DEBUG_VM is not set
-# CONFIG_DEBUG_MEMORY_INIT is not set
-# CONFIG_DEBUG_SHIRQ is not set
-
-#
-# Debug Lockups and Hangs
-#
-CONFIG_LOCKUP_DETECTOR=y
-# CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC is not set
-CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC_VALUE=0
-# CONFIG_DETECT_HUNG_TASK is not set
-# CONFIG_WQ_WATCHDOG is not set
-# CONFIG_PANIC_ON_OOPS is not set
-CONFIG_PANIC_ON_OOPS_VALUE=0
-CONFIG_PANIC_TIMEOUT=0
-# CONFIG_SCHED_DEBUG is not set
-# CONFIG_SCHED_INFO is not set
-# CONFIG_SCHEDSTATS is not set
-# CONFIG_SCHED_STACK_END_CHECK is not set
-# CONFIG_DEBUG_TIMEKEEPING is not set
-# CONFIG_TIMER_STATS is not set
-# CONFIG_DEBUG_PREEMPT is not set
-
-#
-# Lock Debugging (spinlocks, mutexes, etc...)
-#
-CONFIG_DEBUG_RT_MUTEXES=y
-CONFIG_DEBUG_SPINLOCK=y
-CONFIG_DEBUG_MUTEXES=y
-# CONFIG_DEBUG_WW_MUTEX_SLOWPATH is not set
-# CONFIG_DEBUG_LOCK_ALLOC is not set
-# CONFIG_PROVE_LOCKING is not set
-# CONFIG_LOCK_STAT is not set
-# CONFIG_DEBUG_ATOMIC_SLEEP is not set
-# CONFIG_DEBUG_LOCKING_API_SELFTESTS is not set
-# CONFIG_LOCK_TORTURE_TEST is not set
-CONFIG_STACKTRACE=y
-# CONFIG_DEBUG_KOBJECT is not set
-# CONFIG_DEBUG_BUGVERBOSE is not set
-# CONFIG_DEBUG_LIST is not set
-# CONFIG_DEBUG_PI_LIST is not set
-# CONFIG_DEBUG_SG is not set
-# CONFIG_DEBUG_NOTIFIERS is not set
-# CONFIG_DEBUG_CREDENTIALS is not set
-
-#
-# RCU Debugging
-#
-# CONFIG_PROVE_RCU is not set
-# CONFIG_SPARSE_RCU_POINTER is not set
-# CONFIG_TORTURE_TEST is not set
-# CONFIG_RCU_PERF_TEST is not set
-# CONFIG_RCU_TORTURE_TEST is not set
-CONFIG_RCU_CPU_STALL_TIMEOUT=21
-# CONFIG_RCU_TRACE is not set
-# CONFIG_RCU_EQS_DEBUG is not set
-# CONFIG_DEBUG_WQ_FORCE_RR_CPU is not set
-# CONFIG_DEBUG_BLOCK_EXT_DEVT is not set
-# CONFIG_NOTIFIER_ERROR_INJECTION is not set
-# CONFIG_FAULT_INJECTION is not set
-# CONFIG_LATENCYTOP is not set
-CONFIG_HAVE_FUNCTION_TRACER=y
-CONFIG_HAVE_DYNAMIC_FTRACE=y
-CONFIG_HAVE_FTRACE_MCOUNT_RECORD=y
-CONFIG_HAVE_SYSCALL_TRACEPOINTS=y
-CONFIG_HAVE_C_RECORDMCOUNT=y
-CONFIG_TRACING_SUPPORT=y
-# CONFIG_FTRACE is not set
-
-#
-# Runtime Testing
-#
-# CONFIG_LKDTM is not set
-# CONFIG_TEST_LIST_SORT is not set
-# CONFIG_BACKTRACE_SELF_TEST is not set
-# CONFIG_RBTREE_TEST is not set
-# CONFIG_INTERVAL_TREE_TEST is not set
-# CONFIG_PERCPU_TEST is not set
-# CONFIG_ATOMIC64_SELFTEST is not set
-# CONFIG_TEST_HEXDUMP is not set
-# CONFIG_TEST_STRING_HELPERS is not set
-# CONFIG_TEST_KSTRTOX is not set
-# CONFIG_TEST_PRINTF is not set
-# CONFIG_TEST_BITMAP is not set
-# CONFIG_TEST_UUID is not set
-# CONFIG_TEST_RHASHTABLE is not set
-# CONFIG_TEST_HASH is not set
-# CONFIG_DMA_API_DEBUG is not set
-# CONFIG_TEST_LKM is not set
-# CONFIG_TEST_USER_COPY is not set
-# CONFIG_TEST_BPF is not set
-# CONFIG_TEST_UDELAY is not set
-# CONFIG_MEMTEST is not set
-# CONFIG_TEST_STATIC_KEYS is not set
-# CONFIG_SAMPLES is not set
-CONFIG_HAVE_ARCH_KGDB=y
-# CONFIG_KGDB is not set
-# CONFIG_ARCH_WANTS_UBSAN_NO_NULL is not set
-# CONFIG_UBSAN is not set
-CONFIG_ARCH_HAS_DEVMEM_IS_ALLOWED=y
-# CONFIG_STRICT_DEVMEM is not set
-# CONFIG_ARM_PTDUMP is not set
-CONFIG_ARM_UNWIND=y
-# CONFIG_DEBUG_USER is not set
-# CONFIG_DEBUG_LL is not set
-CONFIG_DEBUG_LL_INCLUDE="mach/debug-macro.S"
-# CONFIG_DEBUG_UART_8250 is not set
-CONFIG_UNCOMPRESS_INCLUDE="debug/uncompress.h"
-# CONFIG_PID_IN_CONTEXTIDR is not set
-# CONFIG_DEBUG_SET_MODULE_RONX is not set
-# CONFIG_CORESIGHT is not set
-
-#
-# Security options
-#
-# CONFIG_KEYS is not set
-# CONFIG_SECURITY_DMESG_RESTRICT is not set
-# CONFIG_SECURITY is not set
-# CONFIG_SECURITYFS is not set
-CONFIG_HAVE_HARDENED_USERCOPY_ALLOCATOR=y
-CONFIG_HAVE_ARCH_HARDENED_USERCOPY=y
-# CONFIG_HARDENED_USERCOPY is not set
-CONFIG_DEFAULT_SECURITY_DAC=y
-CONFIG_DEFAULT_SECURITY=""
-CONFIG_CRYPTO=y
-
-#
-# Crypto core or helper
-#
-CONFIG_CRYPTO_ALGAPI=y
-CONFIG_CRYPTO_ALGAPI2=y
-CONFIG_CRYPTO_AEAD=y
-CONFIG_CRYPTO_AEAD2=y
-CONFIG_CRYPTO_BLKCIPHER=y
-CONFIG_CRYPTO_BLKCIPHER2=y
-CONFIG_CRYPTO_HASH=y
-CONFIG_CRYPTO_HASH2=y
-CONFIG_CRYPTO_RNG=y
-CONFIG_CRYPTO_RNG2=y
-CONFIG_CRYPTO_RNG_DEFAULT=y
-CONFIG_CRYPTO_AKCIPHER2=y
-CONFIG_CRYPTO_KPP2=y
-# CONFIG_CRYPTO_RSA is not set
-# CONFIG_CRYPTO_DH is not set
-# CONFIG_CRYPTO_ECDH is not set
-CONFIG_CRYPTO_MANAGER=y
-CONFIG_CRYPTO_MANAGER2=y
-# CONFIG_CRYPTO_USER is not set
-CONFIG_CRYPTO_MANAGER_DISABLE_TESTS=y
-CONFIG_CRYPTO_GF128MUL=m
-CONFIG_CRYPTO_NULL=y
-CONFIG_CRYPTO_NULL2=y
-CONFIG_CRYPTO_WORKQUEUE=y
-# CONFIG_CRYPTO_CRYPTD is not set
-# CONFIG_CRYPTO_MCRYPTD is not set
-# CONFIG_CRYPTO_AUTHENC is not set
-# CONFIG_CRYPTO_TEST is not set
-
-#
-# Authenticated Encryption with Associated Data
-#
-CONFIG_CRYPTO_CCM=m
-CONFIG_CRYPTO_GCM=m
-# CONFIG_CRYPTO_CHACHA20POLY1305 is not set
-CONFIG_CRYPTO_SEQIV=y
-CONFIG_CRYPTO_ECHAINIV=m
-
-#
-# Block modes
-#
-CONFIG_CRYPTO_CBC=y
-CONFIG_CRYPTO_CTR=y
-# CONFIG_CRYPTO_CTS is not set
-CONFIG_CRYPTO_ECB=y
-# CONFIG_CRYPTO_LRW is not set
-# CONFIG_CRYPTO_PCBC is not set
-# CONFIG_CRYPTO_XTS is not set
-# CONFIG_CRYPTO_KEYWRAP is not set
-
-#
-# Hash modes
-#
-CONFIG_CRYPTO_CMAC=y
-CONFIG_CRYPTO_HMAC=y
-# CONFIG_CRYPTO_XCBC is not set
-# CONFIG_CRYPTO_VMAC is not set
-
-#
-# Digest
-#
-# CONFIG_CRYPTO_CRC32C is not set
-CONFIG_CRYPTO_CRC32=y
-# CONFIG_CRYPTO_CRCT10DIF is not set
-CONFIG_CRYPTO_GHASH=m
-# CONFIG_CRYPTO_POLY1305 is not set
-CONFIG_CRYPTO_MD4=y
-CONFIG_CRYPTO_MD5=y
-# CONFIG_CRYPTO_MICHAEL_MIC is not set
-# CONFIG_CRYPTO_RMD128 is not set
-# CONFIG_CRYPTO_RMD160 is not set
-# CONFIG_CRYPTO_RMD256 is not set
-# CONFIG_CRYPTO_RMD320 is not set
-# CONFIG_CRYPTO_SHA1 is not set
-CONFIG_CRYPTO_SHA256=y
-# CONFIG_CRYPTO_SHA512 is not set
-# CONFIG_CRYPTO_SHA3 is not set
-# CONFIG_CRYPTO_TGR192 is not set
-# CONFIG_CRYPTO_WP512 is not set
-
-#
-# Ciphers
-#
-CONFIG_CRYPTO_AES=y
-# CONFIG_CRYPTO_ANUBIS is not set
-CONFIG_CRYPTO_ARC4=y
-# CONFIG_CRYPTO_BLOWFISH is not set
-# CONFIG_CRYPTO_CAMELLIA is not set
-# CONFIG_CRYPTO_CAST5 is not set
-# CONFIG_CRYPTO_CAST6 is not set
-CONFIG_CRYPTO_DES=y
-# CONFIG_CRYPTO_FCRYPT is not set
-# CONFIG_CRYPTO_KHAZAD is not set
-# CONFIG_CRYPTO_SALSA20 is not set
-# CONFIG_CRYPTO_CHACHA20 is not set
-# CONFIG_CRYPTO_SEED is not set
-# CONFIG_CRYPTO_SERPENT is not set
-# CONFIG_CRYPTO_TEA is not set
-# CONFIG_CRYPTO_TWOFISH is not set
-
-#
-# Compression
-#
-CONFIG_CRYPTO_DEFLATE=y
-CONFIG_CRYPTO_LZO=y
-# CONFIG_CRYPTO_842 is not set
-# CONFIG_CRYPTO_LZ4 is not set
-# CONFIG_CRYPTO_LZ4HC is not set
-
-#
-# Random Number Generation
-#
-# CONFIG_CRYPTO_ANSI_CPRNG is not set
-CONFIG_CRYPTO_DRBG_MENU=y
-CONFIG_CRYPTO_DRBG_HMAC=y
-# CONFIG_CRYPTO_DRBG_HASH is not set
-# CONFIG_CRYPTO_DRBG_CTR is not set
-CONFIG_CRYPTO_DRBG=y
-CONFIG_CRYPTO_JITTERENTROPY=y
-# CONFIG_CRYPTO_USER_API_HASH is not set
-# CONFIG_CRYPTO_USER_API_SKCIPHER is not set
-# CONFIG_CRYPTO_USER_API_RNG is not set
-# CONFIG_CRYPTO_USER_API_AEAD is not set
-# CONFIG_CRYPTO_HW is not set
-
-#
-# Certificates for signature checking
-#
-# CONFIG_ARM_CRYPTO is not set
-# CONFIG_BINARY_PRINTF is not set
-
-#
-# Library routines
-#
-CONFIG_BITREVERSE=y
-CONFIG_HAVE_ARCH_BITREVERSE=y
-CONFIG_RATIONAL=y
-CONFIG_GENERIC_STRNCPY_FROM_USER=y
-CONFIG_GENERIC_STRNLEN_USER=y
-CONFIG_GENERIC_NET_UTILS=y
-CONFIG_GENERIC_PCI_IOMAP=y
-CONFIG_GENERIC_IO=y
-CONFIG_ARCH_USE_CMPXCHG_LOCKREF=y
-# CONFIG_CRC_CCITT is not set
-CONFIG_CRC16=y
-# CONFIG_CRC_T10DIF is not set
-# CONFIG_CRC_ITU_T is not set
-CONFIG_CRC32=y
-# CONFIG_CRC32_SELFTEST is not set
-CONFIG_CRC32_SLICEBY8=y
-# CONFIG_CRC32_SLICEBY4 is not set
-# CONFIG_CRC32_SARWATE is not set
-# CONFIG_CRC32_BIT is not set
-# CONFIG_CRC7 is not set
-# CONFIG_LIBCRC32C is not set
-# CONFIG_CRC8 is not set
-# CONFIG_AUDIT_ARCH_COMPAT_GENERIC is not set
-# CONFIG_RANDOM32_SELFTEST is not set
-CONFIG_ZLIB_INFLATE=y
-CONFIG_ZLIB_DEFLATE=y
-CONFIG_LZO_COMPRESS=y
-CONFIG_LZO_DECOMPRESS=y
-CONFIG_XZ_DEC=y
-# CONFIG_XZ_DEC_X86 is not set
-# CONFIG_XZ_DEC_POWERPC is not set
-# CONFIG_XZ_DEC_IA64 is not set
-CONFIG_XZ_DEC_ARM=y
-CONFIG_XZ_DEC_ARMTHUMB=y
-# CONFIG_XZ_DEC_SPARC is not set
-CONFIG_XZ_DEC_BCJ=y
-# CONFIG_XZ_DEC_TEST is not set
-CONFIG_GENERIC_ALLOCATOR=y
-CONFIG_HAS_IOMEM=y
-CONFIG_HAS_IOPORT_MAP=y
-CONFIG_HAS_DMA=y
-CONFIG_DQL=y
-CONFIG_NLATTR=y
-# CONFIG_CORDIC is not set
-# CONFIG_DDR is not set
-# CONFIG_IRQ_POLL is not set
-CONFIG_LIBFDT=y
-# CONFIG_SG_SPLIT is not set
-CONFIG_SG_POOL=y
-CONFIG_ARCH_HAS_SG_CHAIN=y
-CONFIG_SBITMAP=y
-# CONFIG_VIRTUALIZATION is not set
diff --git a/general/package/Config.in b/general/package/Config.in
index eb7150a9..2df50963 100644
--- a/general/package/Config.in
+++ b/general/package/Config.in
@@ -85,6 +85,7 @@ source "$BR2_EXTERNAL_GENERAL_PATH/package/rtw-hostapd/Config.in"
 source "$BR2_EXTERNAL_GENERAL_PATH/package/sigmastar-osdrv-infinity6b0/Config.in"
 source "$BR2_EXTERNAL_GENERAL_PATH/package/sigmastar-osdrv-infinity6e/Config.in"
 source "$BR2_EXTERNAL_GENERAL_PATH/package/sigmastar-osdrv-msc313e/Config.in"
+source "$BR2_EXTERNAL_GENERAL_PATH/package/sigmastar-osdrv-sensor/Config.in"
 source "$BR2_EXTERNAL_GENERAL_PATH/package/ssw101b/Config.in"
 source "$BR2_EXTERNAL_GENERAL_PATH/package/uacme-openipc/Config.in"
 source "$BR2_EXTERNAL_GENERAL_PATH/package/uqmi-openipc/Config.in"
diff --git a/general/package/sigmastar-osdrv-infinity6b0/Config.in b/general/package/sigmastar-osdrv-infinity6b0/Config.in
index a924e332..539c25ce 100644
--- a/general/package/sigmastar-osdrv-infinity6b0/Config.in
+++ b/general/package/sigmastar-osdrv-infinity6b0/Config.in
@@ -1,4 +1,5 @@
 config BR2_PACKAGE_SIGMASTAR_OSDRV_INFINITY6B0
 	bool "sigmastar-osdrv-infinity6b0"
+	select BR2_PACKAGE_SIGMASTAR_OSDRV_SENSOR
 	help
 	  SigmaStar infinity6b0 kernel modules
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/script/load_sigmastar b/general/package/sigmastar-osdrv-infinity6b0/files/script/load_sigmastar
index 5422e608..05aa5b72 100755
--- a/general/package/sigmastar-osdrv-infinity6b0/files/script/load_sigmastar
+++ b/general/package/sigmastar-osdrv-infinity6b0/files/script/load_sigmastar
@@ -4,6 +4,7 @@
 #
 
 PATH_MODULE=/lib/modules/4.9.84/sigmastar
+PATH_SENSOR=${PATH_MODULE}/sensor
 SENSOR=$(fw_printenv -n sensor)
 
 detect_sensor() {
@@ -17,13 +18,13 @@ detect_sensor() {
 set_sensor() {
   case ${SENSOR} in
     gc4653|imx335|sc2239|sc3335)
-      insmod ${PATH_MODULE}/sensor_${SENSOR}_mipi.ko chmap=1
+      insmod ${PATH_SENSOR}/sensor_${SENSOR}_mipi.ko chmap=1
       ;;
     gc2053|sc2335)
-      insmod ${PATH_MODULE}/sensor_${SENSOR}_mipi.ko chmap=1 lane_num=2 hdr_lane_num=2
+      insmod ${PATH_SENSOR}/sensor_${SENSOR}_mipi.ko chmap=1 lane_num=2 hdr_lane_num=2
       ;;
     imx307)
-      insmod ${PATH_MODULE}/sensor_${SENSOR}_mipi.ko chmap=1 lane_num=2 hdr_lane_num=2 mclk=37.125M
+      insmod ${PATH_SENSOR}/sensor_${SENSOR}_mipi.ko chmap=1 lane_num=2 hdr_lane_num=2 mclk=37.125M
       ;;
     *)
       echo -e "\n\e[1;31mUNSUPPORTED sensor found - ${SENSOR}\e[0m\n" | logger -s -t OpenIPC
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/configs/gc2063.bin b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/configs/gc2063.bin
new file mode 100644
index 00000000..3c6069ff
Binary files /dev/null and b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/configs/gc2063.bin differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/configs/imx307.bin b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/configs/imx307.bin
new file mode 100644
index 00000000..dee90f91
Binary files /dev/null and b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/configs/imx307.bin differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_gc2053_mipi.ko b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_gc2053_mipi.ko
deleted file mode 100644
index 58f790c8..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_gc2053_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_gc4653_mipi.ko b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_gc4653_mipi.ko
deleted file mode 100644
index 1f95292f..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_gc4653_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_imx307_mipi.ko b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_imx307_mipi.ko
deleted file mode 100644
index 12e155e3..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_imx307_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_imx335_mipi.ko b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_imx335_mipi.ko
deleted file mode 100644
index 6c56c915..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_imx335_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc2239_mipi.ko b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc2239_mipi.ko
deleted file mode 100644
index f41a9d22..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc2239_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc2335_mipi.ko b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc2335_mipi.ko
deleted file mode 100644
index f1f53038..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc2335_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc3335_mipi.ko b/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc3335_mipi.ko
deleted file mode 100644
index 8497a386..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6b0/files/sensors/kmod/sensor_sc3335_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6b0/sigmastar-osdrv-infinity6b0.mk b/general/package/sigmastar-osdrv-infinity6b0/sigmastar-osdrv-infinity6b0.mk
index 9c37cb43..71e405fe 100644
--- a/general/package/sigmastar-osdrv-infinity6b0/sigmastar-osdrv-infinity6b0.mk
+++ b/general/package/sigmastar-osdrv-infinity6b0/sigmastar-osdrv-infinity6b0.mk
@@ -12,7 +12,6 @@ SIGMASTAR_OSDRV_INFINITY6B0_LICENSE_FILES = LICENSE
 define SIGMASTAR_OSDRV_INFINITY6B0_INSTALL_TARGET_CMDS
 	$(INSTALL) -m 755 -d $(TARGET_DIR)/lib/modules/4.9.84/sigmastar
 	$(INSTALL) -m 644 -t $(TARGET_DIR)/lib/modules/4.9.84/sigmastar $(SIGMASTAR_OSDRV_INFINITY6B0_PKGDIR)/files/kmod/*
-	$(INSTALL) -m 644 -t $(TARGET_DIR)/lib/modules/4.9.84/sigmastar $(SIGMASTAR_OSDRV_INFINITY6B0_PKGDIR)/files/sensors/kmod/*
 
 	$(INSTALL) -m 755 -d $(TARGET_DIR)/etc/firmware
 	$(INSTALL) -m 644 -t $(TARGET_DIR)/etc/firmware $(SIGMASTAR_OSDRV_INFINITY6B0_PKGDIR)/files/sensors/firmware/*
diff --git a/general/package/sigmastar-osdrv-infinity6e/Config.in b/general/package/sigmastar-osdrv-infinity6e/Config.in
index b14e010f..0d62fec3 100644
--- a/general/package/sigmastar-osdrv-infinity6e/Config.in
+++ b/general/package/sigmastar-osdrv-infinity6e/Config.in
@@ -1,4 +1,5 @@
 config BR2_PACKAGE_SIGMASTAR_OSDRV_INFINITY6E
 	bool "sigmastar-osdrv-infinity6e"
+	select BR2_PACKAGE_SIGMASTAR_OSDRV_SENSOR
 	help
 	  SigmaStar infinity6e kernel modules
diff --git a/general/package/sigmastar-osdrv-infinity6e/files/script/load_sigmastar b/general/package/sigmastar-osdrv-infinity6e/files/script/load_sigmastar
index 124f1acc..b9bfd6a4 100755
--- a/general/package/sigmastar-osdrv-infinity6e/files/script/load_sigmastar
+++ b/general/package/sigmastar-osdrv-infinity6e/files/script/load_sigmastar
@@ -4,6 +4,7 @@
 #
 
 PATH_MODULE=/lib/modules/4.9.84/sigmastar
+PATH_SENSOR=${PATH_MODULE}/sensor
 SENSOR=$(fw_printenv -n sensor)
 
 detect_sensor() {
@@ -17,7 +18,7 @@ detect_sensor() {
 set_sensor() {
   case ${SENSOR} in
     imx274|imx335|imx347|imx415|sc8235)
-      insmod ${PATH_MODULE}/sensor_${SENSOR}_mipi.ko chmap=1
+      insmod ${PATH_SENSOR}/sensor_${SENSOR}_mipi.ko chmap=1
       ;;
     *)
       echo -e "\n\e[1;31mUNSUPPORTED sensor found - ${SENSOR}\e[0m\n" | logger -s -t OpenIPC
diff --git a/general/package/sigmastar-osdrv-infinity6e/files/sensors/configs/imx335.bin b/general/package/sigmastar-osdrv-infinity6e/files/sensors/configs/imx335.bin
new file mode 100644
index 00000000..2f665cdf
Binary files /dev/null and b/general/package/sigmastar-osdrv-infinity6e/files/sensors/configs/imx335.bin differ
diff --git a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx274_mipi.ko b/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx274_mipi.ko
deleted file mode 100644
index 90f1935a..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx274_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx335_mipi.ko b/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx335_mipi.ko
deleted file mode 100644
index 10efab76..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx335_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx347_mipi.ko b/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx347_mipi.ko
deleted file mode 100644
index 5f91ac22..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx347_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx415_mipi.ko b/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx415_mipi.ko
deleted file mode 100644
index 6d79ff20..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_imx415_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_sc8235_mipi.ko b/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_sc8235_mipi.ko
deleted file mode 100644
index a462561f..00000000
Binary files a/general/package/sigmastar-osdrv-infinity6e/files/sensors/kmod/sensor_sc8235_mipi.ko and /dev/null differ
diff --git a/general/package/sigmastar-osdrv-infinity6e/sigmastar-osdrv-infinity6e.mk b/general/package/sigmastar-osdrv-infinity6e/sigmastar-osdrv-infinity6e.mk
index d4e30b3f..e5af5226 100644
--- a/general/package/sigmastar-osdrv-infinity6e/sigmastar-osdrv-infinity6e.mk
+++ b/general/package/sigmastar-osdrv-infinity6e/sigmastar-osdrv-infinity6e.mk
@@ -12,7 +12,6 @@ SIGMASTAR_OSDRV_INFINITY6E_LICENSE_FILES = LICENSE
 define SIGMASTAR_OSDRV_INFINITY6E_INSTALL_TARGET_CMDS
 	$(INSTALL) -m 755 -d $(TARGET_DIR)/lib/modules/4.9.84/sigmastar
 	$(INSTALL) -m 644 -t $(TARGET_DIR)/lib/modules/4.9.84/sigmastar $(SIGMASTAR_OSDRV_INFINITY6E_PKGDIR)/files/kmod/*
-	$(INSTALL) -m 644 -t $(TARGET_DIR)/lib/modules/4.9.84/sigmastar $(SIGMASTAR_OSDRV_INFINITY6E_PKGDIR)/files/sensors/kmod/*
 
 	$(INSTALL) -m 755 -d $(TARGET_DIR)/etc/firmware
 	$(INSTALL) -m 644 -t $(TARGET_DIR)/etc/firmware $(SIGMASTAR_OSDRV_INFINITY6E_PKGDIR)/files/sensors/firmware/*
diff --git a/general/package/sigmastar-osdrv-sensor/Config.in b/general/package/sigmastar-osdrv-sensor/Config.in
new file mode 100644
index 00000000..868dfef5
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/Config.in
@@ -0,0 +1,5 @@
+config BR2_PACKAGE_SIGMASTAR_OSDRV_SENSOR
+	bool "sigmastar-osdrv-sensor"
+	default n
+	help
+	  Sigmastar sensor kernel driver
diff --git a/general/package/sigmastar-osdrv-sensor/sigmastar-osdrv-sensor.mk b/general/package/sigmastar-osdrv-sensor/sigmastar-osdrv-sensor.mk
new file mode 100644
index 00000000..b222d579
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/sigmastar-osdrv-sensor.mk
@@ -0,0 +1,20 @@
+################################################################################
+#
+# sigmastar-osdrv-sensor
+#
+################################################################################
+
+SIGMASTAR_OSDRV_SENSOR_LICENSE = MIT
+SIGMASTAR_OSDRV_SENSOR_LICENSE_FILES = LICENSE
+
+define SIGMASTAR_OSDRV_SENSOR_EXTRACT_CMDS
+	cp -r $(SIGMASTAR_OSDRV_SENSOR_PKGDIR)/src/* $(@D)
+endef
+
+SIGMASTAR_OSDRV_SENSOR_MODULE_SUBDIRS = $(OPENIPC_SOC_FAMILY)
+SIGMASTAR_OSDRV_SENSOR_MODULE_MAKE_OPTS = \
+	INSTALL_MOD_DIR=sigmastar \
+	KSRC=$(LINUX_DIR)
+
+$(eval $(kernel-module))
+$(eval $(generic-package))
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/Makefile b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/Makefile
new file mode 100644
index 00000000..b18f8982
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/Makefile
@@ -0,0 +1,9 @@
+EXTRA_CFLAGS += -I $(PWD)/include -I $(KSRC)/drivers/sstar/include
+EXTRA_CFLAGS += -D SENSOR_MODULE_VERSION=$(OPENIPC_SOC_MODEL)-$(OPENIPC_SOC_FAMILY)
+obj-m := $(patsubst $(PWD)/%.c, %.o, $(wildcard $(PWD)/sensor/*.c))
+
+modules:
+	$(MAKE) -C $(KSRC) M=$(PWD) modules
+
+clean:
+	$(MAKE) -C $(KSRC) M=$(PWD) clean
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_ms_cus_sensor.h b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_ms_cus_sensor.h
new file mode 100644
index 00000000..f8914e72
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_ms_cus_sensor.h
@@ -0,0 +1,1029 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+/*! @file drv_ms_cus_sensor.h
+      @brief This file contains Infinity ISP sensor driver interface.
+*/
+
+/** @defgroup group1 ISP Sensor Driver Interface
+* @{
+*/
+
+#ifndef DRV_MS_CUS_SENSOR_H_
+#define DRV_MS_CUS_SENSOR_H_
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <sensor_i2c_api.h>
+
+#define I2C_RETRYTIME (5)
+
+#ifndef SUCCESS
+#define FAIL        (-1)
+#define SUCCESS     0
+#endif
+
+#ifdef __cplusplus
+#define EXPORT_CUS  extern "C"
+#else
+#define EXPORT_CUS
+#endif
+
+#define CUS_CAMSENSOR_HANDLE_MAJ_VER 0x0002
+#define CUS_CAMSENSOR_HANDLE_MIN_VER 0x0002
+
+#define CUS_CAMSENSORIF_MAJ_VER 0x0001
+#define CUS_CAMSENSORIF_MIN_VER 0x0002
+
+#define CUS_CAMSENSOR_I2C_MAJ_VER 0x0001
+#define CUS_CAMSENSOR_I2C_MIN_VER 0x0001
+
+#define CUS_MSTART_CAMSENSOR_CAP_VERSION 0x0001
+
+//#define usleep(usec)  CamOsMsSleep(usec*1000);
+//#define usleep(usec)  udelay(usec)
+//#define ARRAY_SIZE(a) (sizeof(a)/sizeof(a[0]))
+
+#define SENSOR_DRIVER_MODE_NOT_SUUPORT                          (0xFFFF)
+
+struct __ms_cus_sensor; /**< Sensor driver handle */
+//struct __ISensorAPI; /**< Sensor to ISP control interface */
+
+/*! @brief Resolution descriptor*/
+typedef struct _cus_camsensor_res{
+    u32 width;      /**< Image crop width */
+    u32 height;     /**< Image crop height */
+    u32 max_fps; /**< Max fps in this resolution */
+    u32 min_fps;  /**< Min fps in this resolution*/
+    u32 crop_start_x;
+    u32 crop_start_y;
+    u32 nOutputWidth; /**< Sensor actual output width */
+    u32 nOutputHeight; /**< Sensor actual output height */
+    char strResDesc[32];
+} __attribute__((packed, aligned(4))) cus_camsensor_res;
+
+/*! @brief Resolution list*/
+typedef struct _cus_camsensor_res_list
+{
+    u32 num_res;                        /**< number of sensor resolution in list */
+    u32 ulcur_res;                        /**< current sensor resolution*/
+    cus_camsensor_res res[12];      /**< resolution list */
+} __attribute__((packed, aligned(4))) cus_camsensor_res_list;
+
+
+/*! @brief Select sensor type */
+typedef enum {
+    ISP_SOC,                /**< Not support */
+    ISP_EXT                 /**< sensor without built-in ISP */
+} CUS_CAMSENSOR_ISPTYPE;
+
+/*! @brief Sensor bayer raw pixel order */
+typedef enum {
+    CUS_BAYER_RG = 0,       /**< bayer data start with R channel */
+    CUS_BAYER_GR,             /**<  bayer data start with Gr channel */
+    CUS_BAYER_BG,             /**<  bayer data start with B channel */
+    CUS_BAYER_GB              /**<  bayer data start with Gb channel */
+} CUS_SEN_BAYER;
+
+typedef enum {
+    CUS_RGBIR_NONE = 0, /** modify RGBIR pixel order enumeration */
+    CUS_RGBIR_R0 = 1,
+    CUS_RGBIR_G0 = 2,
+    CUS_RGBIR_B0 = 3,
+    CUS_RGBIR_G1 = 4,
+    CUS_RGBIR_G2 = 5,
+    CUS_RGBIR_I0 = 6,
+    CUS_RGBIR_G3 = 7,
+    CUS_RGBIR_I1 = 8
+} CUS_SEN_RGBIR;
+
+/*! @brief Set sensor image mirror and flip.*/
+typedef enum {
+    CUS_ORIT_M0F0,                  /**< mirror, flip unchanged */
+    CUS_ORIT_M1F0,                  /**< mirror changed, flip unchanged */
+    CUS_ORIT_M0F1,                  /**< mirror unchanged, flip changed */
+    CUS_ORIT_M1F1,                  /**< mirror and flip changed */
+} CUS_CAMSENSOR_ORIT;
+
+
+/*! @brief Get input source type.*/
+typedef enum {
+    CUS_SNR_ANADEC_SRC_NO_READY,    /**< input no ready */
+    CUS_SNR_ANADEC_SRC_DISCNT,      /**< input disconnect */
+    CUS_SNR_ANADEC_SRC_PAL,         /**< input type is PAL */
+    CUS_SNR_ANADEC_SRC_NTSC,        /**< input type is NTSC */
+    CUS_SNR_ANADEC_SRC_HD_25P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_HD_30P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_HD_50P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_HD_60P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_FHD_25P,     /**< input source type is FHD */
+    CUS_SNR_ANADEC_SRC_FHD_30P,     /**< input source type is FHD */
+}CUS_SNR_ANADEC_SRC_TYPE;
+
+
+/*! @brief ISP AE event notifycation*/
+typedef enum {
+    CUS_FRAME_INACTIVE = 0, /**< Frame end */
+    CUS_FRAME_ACTIVE = 1,/**< Frame start */
+} CUS_CAMSENSOR_AE_STATUS_NOTIFY;
+
+/*! @brief Sensor bayer raw (8/10 bits) to 12bits mode control */
+typedef enum {
+    CUS_SEN_8TO12_7074,       /**< Do not use*/
+    CUS_SEN_8TO12_7000,       /**< Sensor bayer raw is 8 bits*/
+    CUS_SEN_8TO12_114118,   /**< Do not use*/
+    CUS_SEN_8TO12_11400,     /**< Do not use*/
+    CUS_SEN_10TO12_9098,     /**< Do not use*/
+    CUS_SEN_10TO12_9000,     /**< Sensor bayer raw is 10 bits*/
+    CUS_SEN_10TO12_1121110, /**< Do not use*/
+    CUS_SEN_10TO12_11200    /**< Do not use*/
+} CUS_SEN_FMT_CONV_MODE;
+
+/*! @brief Sensor input raw data precision */
+typedef enum {
+    CUS_DATAPRECISION_8 = 0,    /**< raw data precision is 8bits */
+    CUS_DATAPRECISION_10 = 1,   /**< raw data precision is 10bits */
+    CUS_DATAPRECISION_16 = 2,    /**< raw data precision is 16bits */
+    CUS_DATAPRECISION_12 = 3,   /**< raw data precision is 12bits */
+    CUS_DATAPRECISION_14 = 4,   /**< raw data precision is 14bits */
+} CUS_DATAPRECISION;
+
+/*! @brief Select sensor data intarface */
+typedef enum {
+    CUS_SENIF_BUS_PARL = 0, /**< sensor data bus is parallel bus */
+    CUS_SENIF_BUS_MIPI = 1,  /**<  sensor data bus is mipi */
+    CUS_SENIF_BUS_BT601 = 2,
+    CUS_SENIF_BUS_BT656 = 3,
+    CUS_SENIF_BUS_BT1120 = 4,
+} CUS_SENIF_BUS;
+
+typedef enum {
+    CUS_SEN_INPUT_FORMAT_YUV422,
+    CUS_SEN_INPUT_FORMAT_RGB,
+} CUS_SEN_INPUT_FORMAT;
+
+/*! @brief Select pin polarity */
+typedef enum {
+    CUS_CLK_POL_POS = 0,    /**< High active */
+    CUS_CLK_POL_NEG         /**< Low active */
+} CUS_CLK_POL;
+
+typedef enum
+{
+    CUS_SENSOR_YUV_ORDER_CY = 0,
+    CUS_SENSOR_YUV_ORDER_YC = 1,
+}CUS_SENSOR_YUV_ORDER;
+
+/*! @brief Sensor master clock select */
+typedef enum {
+    CUS_CMU_CLK_27MHZ,
+    CUS_CMU_CLK_21P6MHZ,
+    CUS_CMU_CLK_12MHZ,
+    CUS_CMU_CLK_5P4MHZ,
+    CUS_CMU_CLK_36MHZ,
+    CUS_CMU_CLK_54MHZ,
+    CUS_CMU_CLK_43P2MHZ,
+    CUS_CMU_CLK_61P7MHZ,
+    CUS_CMU_CLK_72MHZ,
+    CUS_CMU_CLK_48MHZ,
+    CUS_CMU_CLK_24MHZ,
+    CUS_CMU_CLK_37P125MHZ,
+    CUS_CMU_CLK_LPLL_DIV1,
+    CUS_CMU_CLK_LPLL_DIV2,
+    CUS_CMU_CLK_LPLL_DIV4,
+    CUS_CMU_CLK_LPLL_DIV8,
+} CUS_MCLK_FREQ; //Depends on chip.
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_PAR_DISABLE,
+    CUS_SR0_PAR_MODE_1,
+    CUS_SR0_PAR_MODE_2,
+} CUS_SR0_PAR_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_BT656_DISABLE,
+    CUS_SR0_BT656_MODE_1,
+    CUS_SR0_BT656_MODE_2,
+    CUS_SR0_BT656_MODE_3,
+    CUS_SR0_BT656_MODE_4,
+} CUS_SR0_BT656_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR1_BT656_DISABLE,
+    CUS_SR1_BT656_MODE_1,
+} CUS_SR1_BT656_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_BT601_DISABLE,
+    CUS_SR0_BT601_MODE_1,
+    CUS_SR0_BT601_MODE_2,
+    CUS_SR0_BT601_MODE_3,
+    CUS_SR0_BT601_MODE_4,
+} CUS_SR0_BT601_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_MIPI_DISABLE,
+    CUS_SR0_MIPI_MODE_1,
+    CUS_SR0_MIPI_MODE_2,
+} CUS_SR0_MIPI_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR1_MIPI_DISABLE,
+    CUS_SR1_MIPI_MODE_1,
+    CUS_SR1_MIPI_MODE_2,
+    CUS_SR1_MIPI_MODE_3,
+    CUS_SR1_MIPI_MODE_4,
+} CUS_SR1_MIPI_MODE;
+
+//Depends on chip definition.
+typedef enum
+{
+    CUS_VIF_BT656_EAV_DETECT = 0,
+    CUS_VIF_BT656_SAV_DETECT = 1,
+}CUS_VIF_BT656_CHANNEL_SELECT;
+
+//Depends on chip definition.
+typedef enum
+{
+    CUS_VIF_BT656_VSYNC_DELAY_1LINE = 0,
+    CUS_VIF_BT656_VSYNC_DELAY_2LINE = 1,
+    CUS_VIF_BT656_VSYNC_DELAY_0LINE = 2,
+    CUS_VIF_BT656_VSYNC_DELAY_AUTO = 3,
+}CUS_VIF_BT656_VSYNC_DELAY;
+
+typedef enum
+{
+    CUS_SENSOR_FUNC_DISABLE = 0,
+    CUS_SENSOR_FUNC_ENABLE = 1,
+}CUS_SENSOR_FUNC;
+
+typedef enum
+{
+    CUS_SENSOR_PAD_GROUP_A = 0,
+    CUS_SENSOR_PAD_GROUP_B = 1,
+    CUS_SENSOR_PAD_GROUP_C = 2,
+    CUS_SENSOR_PAD_GROUP_D = 3,
+}CUS_SENSOR_PAD_GROUP;
+
+typedef enum
+{
+    CUS_SENSOR_MASTER_MODE = 0,
+    CUS_SENSOR_SLAVE_MODE = 1,
+}CUS_SENSOR_MODE;
+
+typedef enum
+{
+    CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL = 0,
+    CUS_SENSOR_CHANNEL_MODE_REALTIME_HDR = 1,
+    CUS_SENSOR_CHANNEL_MODE_RAW_STORE = 2,
+    CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR = 3,
+}CUS_SENSOR_CHANNEL_MODE;
+
+typedef struct {
+    unsigned int gain;
+    unsigned int offset;
+} CUS_GAIN_GAP_ARRAY;
+
+//////////////////////////////////////
+// sensor functions
+//////////////////////////////////////
+
+typedef struct {
+    u32 length;     //header length
+    u32 version;         //version
+}CUS_CAMSENSOR_CAP;
+
+/////////////////// ISP for SENSOR API ///////////////////
+typedef enum {
+    CUS_INT_TASK_AE     = (1<<0),
+    CUS_INT_TASK_AWB    = (1<<1),
+    CUS_INT_TASK_AF     = (1<<2),
+    CUS_INT_TASK_VS     = (1<<3),
+    CUS_INT_TASK_VDOS   = (1<<4),
+} CUS_INT_TASK_TYPE;
+
+#define MAX_RUN_ORDER 16
+typedef struct {
+    u8 RunLength;
+    u8 Orders[MAX_RUN_ORDER];
+    u8 CurTaskType;
+} CUS_INT_TASK_ORDER;
+
+/////////////////// Shutter Info ///////////////////////
+/*! @brief Report shutter information */
+typedef struct {
+    u32 length;    /**< struct size */
+    u32 max;       /**< maximun shutter in us*/
+    u32 min;        /**< minimum shutter in us*/
+    u32 step;       /**< shutter in step us*/
+} CUS_SHUTTER_INFO;
+
+////////////////// CSI CLOCK ////////////////////////
+/*! @brief Select MIPI clock*/
+typedef enum {
+    CUS_CSI_CLK_DISABLE = -1, /**< Disable MIPI clock*/
+    CUS_CSI_CLK_108M = 0,    /**< MIPI pixel rate 864Mbps (1-lane)*/
+    CUS_CSI_CLK_86M = 1, /**< MIPI pixel rate 344Mbps(1-lane)*/
+    CUS_CSI_CLK_144M = 2, /**< MIPI pixel rate 1152Mbps(1-lane)*/
+    CUS_CSI_CLK_172M = 3,
+    CUS_CSI_CLK_216M = 4,
+    CUS_CSI_CLK_288M = 5,
+    CUS_CSI_CLK_40M = 6,
+    CUS_CSI_CLK_24M = 7,
+    CUS_CSI_CLK_12M = 8,
+    CUS_CSI_CLK_123M = 9
+}CUS_CSI_CLK;
+
+///////////////// SENSOR PIN CONFIG/////////////////
+/*! @brief Sensor pin assignment*/
+typedef enum {
+    CUS_SR_PAD_CFG_1 = 1,       /**< Pin config for MIPI 1/2 lanes*/
+    CUS_SR_PAD_CFG_MIPI = 1,  /**< Pin config for  MIPI 1/2 lanes*/
+    CUS_SR_PAD_CFG_2 = 2,       /**< Reserved */
+    CUS_SR_PAD_CFG_3 = 3,       /**< Reserved */
+    CUS_SR_PAD_CFG_10BITS = 4,    /**< Pin config for parallel interface 10 bits */
+    CUS_SR_PAD_CFG_4 = 4,        /**< Pin config for parallel interface 12 bits */
+    CUS_SR_PAD_CFG_12BITS = 5,  /**< Pin config for parallel interface 12 bits */
+    CUS_SR_PAD_CFG_5 = 5,       /**< Pin config for parallel interface 12 bits */
+    CUS_SR_PAD_CFG_6 = 6       /**< Pin config for parallel interface 12 bits */
+ }CUS_SR_PAD_CFG;
+
+/*! @brief virtual channel0 hsync. mode */
+typedef enum
+{
+    PACKET_HEADER_EDGE1 = 0,    /**< packet header edge */
+    PACKET_HEADER_EDGE2 = 1,    /**< line end edge */
+    PACKET_HEADER_EDGE3 = 2,    /**< line start edge */
+    PACKET_FOOTER_EDGE = 3,      /**< packet footer edge */
+}CUS_CSI_VC_HS_MODE;
+
+typedef enum
+{
+    CUS_HDR_MODE_NONE = 0,
+    CUS_HDR_MODE_SONY_DOL = 1,
+    CUS_HDR_MODE_DCG = 2,
+    CUS_HDR_MODE_EMBEDDED_RAW8 = 3,
+    CUS_HDR_MODE_EMBEDDED_RAW10 = 4,
+    CUS_HDR_MODE_EMBEDDED_RAW12 = 5,
+    CUS_HDR_MODE_EMBEDDED_RAW16 = 6, //Only for OV2718?
+    CUS_HDR_MODE_LI = 7,
+    CUS_HDR_MODE_MULTI_VC = 8,
+}CUS_HDR_MODE;
+
+typedef enum
+{
+    // Index 0
+    SENSOR_DRIVER_MODE_VGA_30P_RESOLUTION,                    // 640*360 30P
+    SENSOR_DRIVER_MODE_VGA_50P_RESOLUTION,                    // 640*360 50P
+    SENSOR_DRIVER_MODE_VGA_60P_RESOLUTION,                    // 640*360 60P
+    SENSOR_DRIVER_MODE_VGA_100P_RESOLUTION,                   // 640*360 100P
+    SENSOR_DRIVER_MODE_VGA_120P_RESOLUTION,                   // 640*360 120P
+
+    // Index 5
+    SENSOR_DRIVER_MODE_HD_24P_RESOLUTION,                     // 1280*720 24P
+    SENSOR_DRIVER_MODE_HD_30P_RESOLUTION,                     // 1280*720 30P
+    SENSOR_DRIVER_MODE_HD_50P_RESOLUTION,                     // 1280*720 50P
+    SENSOR_DRIVER_MODE_HD_60P_RESOLUTION,                     // 1280*720 60P
+    SENSOR_DRIVER_MODE_HD_100P_RESOLUTION,                    // 1280*720 100P
+
+    // Index 10
+    SENSOR_DRIVER_MODE_HD_120P_RESOLUTION,                    // 1280*720 120P
+    SENSOR_DRIVER_MODE_1600x900_30P_RESOLUTION,               // 1600*900 30P
+    SENSOR_DRIVER_MODE_FULL_HD_15P_RESOLUTION,                // 1920*1080 15P
+    SENSOR_DRIVER_MODE_FULL_HD_24P_RESOLUTION,                // 1920*1080 24P
+    SENSOR_DRIVER_MODE_FULL_HD_25P_RESOLUTION,                // 1920*1080 25P
+
+    // Index 15
+    SENSOR_DRIVER_MODE_FULL_HD_30P_RESOLUTION,                // 1920*1080 30P
+    SENSOR_DRIVER_MODE_FULL_HD_50P_RESOLUTION,                // 1920*1080 50P
+    SENSOR_DRIVER_MODE_FULL_HD_60P_RESOLUTION,                // 1920*1080 60P
+    SENSOR_DRIVER_MODE_SUPER_HD_30P_RESOLUTION,               // 2304*1296 30P
+    SENSOR_DRIVER_MODE_SUPER_HD_25P_RESOLUTION,               // 2304*1296 25P
+
+    // Index 20
+    SENSOR_DRIVER_MODE_SUPER_HD_24P_RESOLUTION,               // 2304*1296 24P
+    SENSOR_DRIVER_MODE_1440_30P_RESOLUTION,                   // 2560*1440 30P
+    SENSOR_DRIVER_MODE_2D7K_15P_RESOLUTION,                   // 2704*1524 15P
+    SENSOR_DRIVER_MODE_2D7K_30P_RESOLUTION,                   // 2704*1524 30P
+    SENSOR_DRIVER_MODE_4K2K_15P_RESOLUTION,                   // 3840*2160 15P
+
+    // Index 25
+    SENSOR_DRIVER_MODE_4K2K_30P_RESOLUTION,                   // 3840*2160 30P
+    SENSOR_DRIVER_MODE_4TO3_VGA_30P_RESOLUTION,               // 640*480   30P
+    SENSOR_DRIVER_MODE_4TO3_1D2M_30P_RESOLUTION,              // 1280*960  30P
+    SENSOR_DRIVER_MODE_4TO3_1D5M_30P_RESOLUTION,              // 1440*1080 30P
+    SENSOR_DRIVER_MODE_4TO3_3M_15P_RESOLUTION,                // 2048*1536 15P
+
+    // Index 30
+    SENSOR_DRIVER_MODE_4TO3_3M_30P_RESOLUTION,                // 2048*1536 30P
+    SENSOR_DRIVER_MODE_4TO3_5M_15P_RESOLUTION,                // 2560*1920 15P
+    SENSOR_DRIVER_MODE_4TO3_5M_30P_RESOLUTION,                // 2560*1920 30P
+    SENSOR_DRIVER_MODE_4TO3_8M_15P_RESOLUTION,                // 3264*2448 15P
+    SENSOR_DRIVER_MODE_4TO3_8M_30P_RESOLUTION,                // 3264*2448 30P
+
+    // Index 35
+    SENSOR_DRIVER_MODE_4TO3_10M_15P_RESOLUTION,               // 3648*2736 15P
+    SENSOR_DRIVER_MODE_4TO3_10M_30P_RESOLUTION,               // 3648*2736 30P
+    SENSOR_DRIVER_MODE_4TO3_12M_15P_RESOLUTION,               // 4032*3024 15P
+    SENSOR_DRIVER_MODE_4TO3_12M_30P_RESOLUTION,               // 4032*3024 30P
+    SENSOR_DRIVER_MODE_4TO3_14M_15P_RESOLUTION,               // 4352*3264 15P
+
+    // Index 40
+    SENSOR_DRIVER_MODE_4TO3_14M_30P_RESOLUTION,               // 4352*3264 30P
+    SENSOR_DRIVER_MODE_4K2K_24P_RESOLUTION,
+    SENSOR_DRIVER_MODE_PAL_25P_RESOLUTION,
+    SENSOR_DRIVER_MODE_NTSC_30P_RESOLUTION,
+
+    // For Camera Preview
+    SENSOR_DRIVER_MODE_BEST_CAMERA_PREVIEW_RESOLUTION,
+    SENSOR_DRIVER_MODE_BEST_CAMERA_CAPTURE_16TO9_RESOLUTION,
+    SENSOR_DRIVER_MODE_BEST_CAMERA_CAPTURE_4TO3_RESOLUTION,
+    SENSOR_DRIVER_MODE_FULL_HD_30P_RESOLUTION_HDR,
+} CUS_SNR_RESOLUTION;
+
+
+#ifdef __cplusplus
+extern "C"
+#endif
+
+/**@brief ISP sensor interface control API */
+typedef struct __ISensorIfAPI //isp sensor interface API
+{
+    version_info version;
+    /**@brief Reserved */
+    void* pdata;
+
+    /** @brief Set sensor power down pin.
+    @param[in] idx Sensor pad ID.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*PowerOff)(u32 idx, CUS_CLK_POL pol);
+
+    /** @brief Set sensor power reset pin.
+    @param[in] idx Sensor pad ID.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*Reset)(u32 idx, CUS_CLK_POL pol);
+
+    /** @brief Configure sensor master clock.
+    @param[in] idx Sensor pad ID.
+    @param[in] bONOFF Clock ON/OFF control.
+    @param[in] mclk Clock frequency Hz.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*MCLK)(u32 idx, u8 bONOFF, CUS_MCLK_FREQ mclk);
+
+    /** @brief Query sensor master clock.
+    @param[in] idx Sensor pad ID.
+    @param[in] mclk Query if clock frequency Hz is available.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*QueryMCLK)(u32 idx, CUS_MCLK_FREQ mclk);
+
+    /** @brief Query MIPI lane number.
+    @param[in] idx Sensor pad ID.
+    @param[in] lane_num Query max lane number.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*QueryLaneNum)(u32 idx, u8 *max_lane);
+#if 0
+    /** @brief Select pixel clock source
+    @remarks Parallel interface only
+    @param[in] handle Handle to sensor driver.
+    @param[in] pclk_source Clock source.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*PCLK)(CUS_PCLK_SOURCE pclk_source);        //senect sensor
+
+    /** @brief Configure HSYNC pin polarity.
+    @remarks Parallel interface only
+    @param[in] handle Handle to sensor driver.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*HsyncPol)(CUS_CLK_POL pol);
+
+    /** @brief [parallel interface only] Configure VSYNC pin polarity.
+    @param[in] handle Handle to sensor driver.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*VsyncPol)(CUS_CLK_POL pol);
+
+    /** @brief Configure PCLK pin polarity.
+    @param[in] handle Handle to sensor driver.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*ClkPol)(CUS_CLK_POL pol);
+
+    /** @brief Configure sensor bayer raw pixel order
+    @param[in] handle Handle to sensor driver.
+    @param[in] bayer_id Select pixel order
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*BayerFmt)(CUS_SEN_BAYER bayer_id);
+
+    /** @brief Configure sensor RGBIR (8 or 10bits) convert to 12bit bits isp input, This config will be ignore for 12/16 bits sensor bayer raw input.
+    @param[in] handle Handle to sensor driver.
+    @param[in] mode Mode select
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*FmtConv)(CUS_SEN_FMT_CONV_MODE mode);
+
+    /** @brief Select sensor image data interface
+    @param[in] handle Handle to sensor driver.
+    @param[in] bus Sensor interface
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*DataBus)(CUS_SENIF_BUS bus);
+
+    /** @brief Configure sensor bayer raw pixel bits
+    @param[in] handle Handle to sensor driver.
+    @param[in] prec Select pixel bits
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*DataPrecision)(CUS_DATAPRECISION prec);
+
+    /** @brief Wait isp frame start event
+    @param[in] handle Handle to sensor driver.
+    @param[in] ms Max timeout in ms
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*WaitVStart)(int ms);
+
+    /** @brief Wait isp frame end event
+    @param[in] handle Handle to sensor driver.
+    @param[in] ms Max timeout in ms
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*WaitVEnd)(int ms);
+
+    /** @brief Configure 3A task order table
+    @param[in] handle Handle to sensor driver.
+    @param[in] tasks Task order table
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*Set3ATaskOrder)(CUS_INT_TASK_ORDER tasks);
+#endif
+    /** @brief Select sensor IO pin assignment
+    @param[in] idx Sensor pad ID.
+    @param[in] ulSnrType Interface type.
+    @param[in] ulSnrPadCfg Pin config.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetIOPad)(u32 idx, CUS_SENIF_BUS ulSnrType, u32 ulSnrPadCfg);
+
+    //FOR CSI
+
+    /** @brief Set maximum mipi data rate (amount of all lans)
+    @remarks MIPI interface only.
+    @param[in] idx Sensor pad ID.
+    @param[in] clk Max data rate.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_Clk)(u32 idx, CUS_CSI_CLK clk);
+
+    /** @brief Set number of MIPI lanes
+    @remarks MIPI interface only.
+    @param[in] idx Sensor pad ID.
+    @param[in] num_lan Number of lanes.
+    @param[in] bon_off Clock ON/OFF control.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_Lane)(u32 idx, u16 num_lan, u8 bon_off);
+
+    /** @brief Enable long packet type
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] ctl_cfg0_15 Control flag bit[0:15]
+    @param[in] ctl_cfg16_31 Control flag bit[16:31]
+    @param[in] ctl_cfg32_47 Control flag bit[32:47]
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_LongPacketType)(u32 idx, u16 ctl_cfg0_15, u16 ctl_cfg16_31, u16 ctl_cfg32_47);
+
+    /** @brief Virtual channel0 hsync mode
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] mode HSYNC mode.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_VC0HSmode)(CUS_CSI_VC_HS_MODE mode);
+
+    /** @brief Configure MIPI capture start timing
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] rx_clk_skip_ns
+    @param[in] rx_data_skip_ns
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_clk_data_skip)(u32 idx, u8 rx_clk_skip_ns,u8 rx_data_skip_ns);
+
+    /** @brief Configure MIPI hdr mode
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] hdr_mode HDR mode.
+    @param[in] bon_off Clock ON/OFF control.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_hdr_mode)(u32 idx, CUS_HDR_MODE hdr_mode, u8 bon_off);
+
+#if 0
+    /** @brief Configure sensor RGBIR raw pixel order
+    @param[in] handle Handle to sensor driver.
+    @param[in] bayer_id Select pixel order
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*RGBIRFmt)(CUS_SEN_RGBIR RGBIR_id);
+#endif
+
+    /** @brief Skip vif output frame
+    @remarks Skip Frame interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] fps Sensor current fps.
+    @param[in] cnt Skip counter
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetSkipFrame)(u32 idx, u32 fps, u32  cnt);
+}ISensorIfAPI;
+
+typedef union {
+    //Parallel sensor
+    struct {
+        u32 parallel_reserved; //No additional attribute.
+    } attr_parallel;
+
+    //MIPI sensor
+    struct {
+        u32 mipi_lane_num;
+        u32 mipi_data_format; //0: YUV 422 format. 1: RGB pattern.
+        u32 mipi_yuv_order; //YUYV or UYVY
+        u32 mipi_hsync_mode;
+        u32 mipi_sampling_delay; /** < MIPI start sampling delay */ /*bit 0~7: clk_skip_ns. bit 8~15: data_skip_ns*/
+        CUS_HDR_MODE mipi_hdr_mode;
+        u32 mipi_hdr_virtual_channel_num;
+    } attr_mipi;
+
+    //BT656 sensor
+    struct {
+        u32 bt656_total_ch;
+        u32 bt656_cur_ch;
+        u32 bt656_ch_det_en;
+        CUS_VIF_BT656_CHANNEL_SELECT bt656_ch_det_sel;
+        u32 bt656_bit_swap;
+        u32 bt656_8bit_mode;
+        CUS_VIF_BT656_VSYNC_DELAY bt656_vsync_delay;
+        u32 bt656_hsync_inv;
+        u32 bt656_vsync_inv;
+        u32 bt656_clamp_en;
+    } attr_bt656;
+}  InterfaceAttr_u;
+
+///////////////////////////////////////////////////////
+
+/** @brief Sensor driver interface \n
+The function here are implemented by sensor driver.
+*/
+typedef struct __ms_cus_sensor{
+    //short     lib_idx;      /**< Reserved , Do not use */
+    version_info version;
+    char model_id[32];      /**< Please fill the sensor modle id string here then libcamera user can read model_id by using cameraGetSensorModelID() .*/
+    void *sen_handle;       /**< Reserved , Do not use */
+    void *private_data;     /**< sensor driver dependent variables should store in private_data and free when release */
+    void *slave_mode_set;   /**< Reserved , For sensor vsync/hsync control*/
+
+    // i2c
+    app_i2c_cfg i2c_cfg;           /**< Sensor i2c setting */
+    i2c_handle_t *i2c_bus;         /**< Handle to sensor i2c API. */
+
+    // sensor if api
+    ISensorIfAPI *sensor_if_api;   /**< sensor interface API */
+
+    // ae parameters
+    int ae_gain_delay;      /**< How many frame delay from writing AE gain to take effect*/
+    int ae_shutter_delay;   /**< How many frame delay from writing AE shutter to take effect*/
+    int ae_gain_ctrl_num;
+    int ae_shutter_ctrl_num;
+
+    // polarity
+    CUS_CLK_POL reset_POLARITY;   /** < Sensor REST pin polarity */
+    CUS_CLK_POL pwdn_POLARITY;    /** < Sensor Power Down pin polarity */
+    CUS_CLK_POL VSYNC_POLARITY;   /** < Sensor VSYNC polarity */
+    CUS_CLK_POL HSYNC_POLARITY;   /** < Sensor HSYNC pin polarity */
+    CUS_CLK_POL PCLK_POLARITY;    /** < Sensor Plxel Clock pin polarity */
+
+    // sensor data enum list*/
+    CUS_CAMSENSOR_ISPTYPE   isp_type;    /** < Always use ISP_EXT */
+    CUS_SEN_BAYER           bayer_id;    /** < Sensor bayer raw pixel order */
+    CUS_SEN_RGBIR           RGBIR_id;    /** < Sensor bayer raw pixel order */
+    CUS_SENIF_BUS           sif_bus;     /** < Select sensor interface */
+    CUS_DATAPRECISION       data_prec;   /** < Raw data bits */
+    CUS_SEN_FMT_CONV_MODE   data_mode;   /** < Data convert mode*/
+    CUS_CAMSENSOR_ORIT      orient;      /** < Sensor mirror/flip */
+    CUS_SENSOR_PAD_GROUP    snr_pad_group;
+    CUS_SENSOR_MODE         snr_pad_mode;       /** < support master/slave mode sensor */
+
+    cus_camsensor_res_list  video_res_supported; /** < Resolution list */
+    InterfaceAttr_u         interface_attr;
+
+   //sensor calibration
+    u32                     mclk;        /** < Sensor master clock frequency */
+    u32                     sat_mingain;    /**< Minimum AE gain */
+    u32                     ir_only_fmt;
+
+    ////////////////////////////////////////////////
+    // system functions
+    ////////////////////////////////////////////////
+
+    /** @brief Sensor power on sequence, I2C must be ready after calling this function
+    @param[in] handle Handle to sensor driver.
+    @remark Following configuration need to set up at this stage \n
+    @ref __ISensorIfAPI::Reset Reset sensor \n
+    @ref __ISensorIfAPI::PowerOff Sensor power down pin \n
+    @ref __ISensorIfAPI::MCLK Sensor master clock \n
+    @ref __ISensorIfAPI::SetIOPad ISP sensor IO \n
+    @ref __ISensorIfAPI::SetCSI_Clk  [MIPI sensor only] MIPI clock\n
+    @ref __ISensorIfAPI::HsyncPol Hsync polarity\n
+    @ref __ISensorIfAPI::VsyncPol Vsync polarity\n
+    @ref __ISensorIfAPI::ClkPol [Parallel sensor only]  Pixel clock polarity\n
+    @ref __ISensorIfAPI::BayerFmt Raw data format\n
+    @ref __ISensorIfAPI::DataPrecision Raw data pixel bits\n
+    @ref __ISensorIfAPI::FmtConv Raw data to ISP pixel convert\n
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_poweron)(struct __ms_cus_sensor* handle, u32 idx);
+
+    /** @brief Sensor power off
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_poweroff)(struct __ms_cus_sensor* handle, u32 idx);
+
+    /** @brief Sensor initialization
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark Fill sensor initial table here, Sensor beginning to output raw images after calling this function .
+    */
+    int (*pCus_sensor_init)(struct __ms_cus_sensor* handle);
+
+    /** @brief Sensor Post initialization
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark Fill sensor initial table here, Sensor beginning to output raw images after calling this function .
+    */
+    int (*pCus_sensor_post_init)(struct __ms_cus_sensor* handle, u32 idx);
+
+    /** @brief Release resources those allocated in cus_camsensor_init_handle()
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark Release resource allocated in \ref cus_camsensor_init_handle
+    */
+    int (*pCus_sensor_release)(struct __ms_cus_sensor* handle);
+
+    /** @brief Enter sensor suspend mode
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark ISP call this function before enter power saving mode
+    */
+    int (*pCus_sensor_suspend)(struct __ms_cus_sensor* handle);
+
+    /** @brief Sensor wakeup
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark ISP call this function after exit power saving mode
+    */
+    int (*pCus_sensor_resume)(struct __ms_cus_sensor* handle);
+
+    /** @brief Enable sensor pattern mode if sensor hardward supported
+    @param[in] handle Handle to sensor driver.
+    @param[in] mode Pattern select, if 0 disable pattern mode.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark This function is optional
+    */
+    int (*pCus_sensor_SetPatternMode)(struct __ms_cus_sensor* handle,u32 mode);
+
+    // Normal
+
+    /** @brief Check sensor ID and report to ISP sensor match or not
+    @param[in] handle Handle to sensor driver.
+    @param[out] id Receive 4 bytes customer defined sensor ID.
+    @retval Return SUCCESS if sensor matched or Retuen FAIL if sensor mismatch.
+    @remark Read sensor ID through I2C
+    */
+    int (*pCus_sensor_GetSensorID)(struct __ms_cus_sensor* handle, u32 *id);
+
+     /** @brief Get resolution list
+    @param[in] handle Handle to sensor driver.
+    @param[out] id Receive supported resolution list
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetVideoRes)(struct __ms_cus_sensor* handle, u32 res_idx, cus_camsensor_res **res);
+
+     /** @brief Get resolution list
+    @param[in] handle Handle to sensor driver.
+    @param[out] id Receive supported resolution list
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetCurVideoRes)(struct __ms_cus_sensor* handle, u32 *cur_idx, cus_camsensor_res **res);
+
+     /** @brief Select a sensor output resolution sensor list
+    @param[in] handle Handle to sensor driver.
+    @param[in] res_id Resolution id
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_SetVideoRes)(struct __ms_cus_sensor* handle, u32 res_id);
+
+     /** @brief Get sensor current mirror flip setting
+    @param[in] handle Handle to sensor driver.
+    @param[out] ori Receive Mirror/Flip setting.
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetOrien)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_ORIT *ori);
+
+     /** @brief Select a sensor mirror flip
+    @param[in] handle Handle to sensor driver.
+    @param[in] ori Mirror/Flip configuration.
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_SetOrien)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_ORIT ori);
+
+     /** @brief Get sensor capability
+    @param[in] handle Handle to sensor driver.
+    @param[out] cap Receive sensor capability
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetSensorCap)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_CAP *cap);
+
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+
+     /** @brief AE/Frame status change notification
+    @param[in] handle Handle to sensor driver.
+    @param[in] status Current status
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_AEStatusNotify)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+
+     /** @brief Get sensor shutter setting in us
+    @param[in] handle Handle to sensor driver.
+    @param[out] us Receive current shutter setting
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetAEUSecs)(struct __ms_cus_sensor* handle, u32 *us);
+
+     /** @brief Set sensor shutter in us
+    @param[in] handle Handle to sensor driver.
+    @param[in] us Shutter setting in us
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_SetAEUSecs)(struct __ms_cus_sensor* handle, u32 us);
+
+    // Gain: 1x = 1024
+    /** @brief Get sensor current AE gain
+    @param[in] handle Handle to sensor driver.
+    @param[out] gain Receive current AE gain
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_GetAEGain)(struct __ms_cus_sensor* handle, u32* gain);
+
+    /** @brief Set sensor AE gain
+    @param[in] handle Handle to sensor driver.
+    @param[in] gain AE gain
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_SetAEGain)(struct __ms_cus_sensor* handle, u32 gain);
+
+    /** @brief Get supported shutter range
+    @param[in] handle Handle to sensor driver.
+    @param[out] min Receive minimum shutter which sensor can supported
+    @param[out] min Receive maxiimum shutter which sensor can supported
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_GetAEMinMaxUSecs)(struct __ms_cus_sensor* handle, u32 *min, u32 *max);
+
+    /** @brief Get supported AE gain range
+    @param[in] handle Handle to sensor driver.
+    @param[out] min Receive minimum gain which sensor can supported
+    @param[out] min Receive maxiimum gain which sensor can supported
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_GetAEMinMaxGain)(struct __ms_cus_sensor* handle, u32 *min, u32 *max);
+
+    // frame rate control
+    /** @brief Get current fps
+    @param[in] handle Handle to sensor driver.
+    @retval Return current frame rate per second
+    */
+    int (*pCus_sensor_GetFPS)(struct __ms_cus_sensor* handle);
+
+    /** @brief Set sensor output fps
+    @param[in] handle Handle to sensor driver.
+    @param[in] fps
+    @retval Return SUCCESS or FAIL if fps is out of range.
+    */
+    int (*pCus_sensor_SetFPS)(struct __ms_cus_sensor* handle, u32 fps);
+
+    //[OPTIONAL] sensor calibration
+    /** @brief Optional function */
+    int (*pCus_sensor_SetAEGain_cal)(struct __ms_cus_sensor* handle, u32);
+
+    /** @brief Optional function */
+    int (*pCus_sensor_setCaliData_gain_linearity)(struct __ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray ,u32 num);
+
+    //Get shutter information
+    /** @brief Get shutter information
+    @param[in] handle Handle to sensor driver.
+    @param[out] info return shutter information.
+    @retval Return current frame rate per second
+    */
+    int (*pCus_sensor_GetShutterInfo)(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info);
+
+    /** @brief Get resolution list number
+   @param[in] handle Handle to sensor driver.
+   @param[out] ulres_num resolution list number
+   @retval Return SUCCESS or FAIL if error occurs.
+   */
+   int (*pCus_sensor_GetVideoResNum)(struct __ms_cus_sensor* handle, u32 *ulres_num);
+
+   //Get shutter information
+   /** @brief Sensor vendor command
+   @param[in] handle Handle to sensor driver.
+   @param[in] reserved
+   @param[in] param Command input
+   @param[out] out Command output
+   @retval Return SUCCESS or FAIL if error occurs.
+   */
+   int (*pCus_sensor_CustDefineFunction)(struct __ms_cus_sensor* handle,u32 cmd_id, void *param);
+
+   //Get Source Type
+   /** @brief Get Source Type
+   @param[in] handle Handle to sensor driver.
+   @param[in] plane id.
+   @param[out] psrc_type info
+   @retval Return SUCCESS or FAIL if error occurs.
+   */
+   int (*pCus_sensor_GetSrcType)(struct __ms_cus_sensor* handle, u32 plane_id, CUS_SNR_ANADEC_SRC_TYPE *psrc_type);
+
+   // Gain: 1x = 1024
+   /** @brief Try AE gain value
+   @param[in] handle Handle to sensor driver.
+   @param[in] Target AE gain value to try
+   @retval Return actual sensor gain will apply on the HW.
+   @remark gain: 1x = 1024
+   */
+   u32 (*pCus_sensor_TryAEGain)(struct __ms_cus_sensor* handle, u32 gain);
+
+   // Return actual shutter
+   /** @brief Try AE shutter value
+   @param[in] handle Handle to sensor driver.
+   @param[in] Target AE shutter value to try , in us
+   @retval Return actual sensor gain will apply on the HW.
+   @remark gain: 1x = 1024
+   */
+   u32 (*pCus_sensor_TryAEShutter)(struct __ms_cus_sensor* handle, u32 us);
+} ms_cus_sensor;
+
+/** @brief Sensor driver entry. ISP call this function before start using sensor driver. \n
+ISP pass \ref ms_cus_sensor struct to obtain the driver information and function entries. \n
+And all allocated resources here should be released at \ref __ms_cus_sensor::pCus_sensor_release.
+Every sensor driver must implement this api.
+@param[in] drv_handle A uninitialized \ref ms_cus_sensor struct from ISP, Sensor driver fill the driver information and function entries to drv_handle.
+@retval SUCCESS or FAIL if error occurs.
+*/
+
+typedef int (*SensorInitHandle)(ms_cus_sensor* handle);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* DRV_MS_CUS_SENSOR_H_ */
+/** @} */ // end of ISP Sensor Driver Interface
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor.h b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor.h
new file mode 100644
index 00000000..36452880
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor.h
@@ -0,0 +1,53 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifndef DRV_SENSOR_H
+#define DRV_SENSOR_H
+
+#include <cam_os_wrapper.h>
+
+#define SENSOR_DMSG(args...) do{}while(0)
+#define SENSOR_EMSG(args...) CamOsPrintf(args)
+#define SENSOR_IMSG(args...) CamOsPrintf(args)
+#if 0
+typedef enum {
+    I2C_FMT_A8D8, /**< 8 bits Address, 8 bits Data */
+    I2C_FMT_A16D8,/**< 16 bits Address 8 bits Data */
+    I2C_FMT_A8D16,/**< 8 bits Address 16 bits Data */
+    I2C_FMT_A16D16,/**< 16 bits Address 16 bits Data */
+    I2C_FMT_END/**< Reserved */
+} ISP_I2C_FMT;
+#endif
+
+extern s32 WriteRegisterPair(int slaveAddr, short reg, unsigned short value, ISP_I2C_FMT fmt);
+extern u64 intlog10(u32 value);
+extern u64 intlog2(u32 value);
+extern s32 DrvRegisterSensorDriver(u32 nCamID, SensorInitHandle pfnSensorInitHandle);
+extern s32 DrvRegisterPlaneDriver(u32 nCamID, u32 nPlaneID, SensorInitHandle pfnSensorInitHandle);
+extern s32 DrvRegisterSensorDriverEx(u32 nSNRPadID, SensorInitHandle pfnSensorInitHandle, void *pPrivateData);
+extern s32 DrvRegisterPlaneDriverEx(u32 nSNRPadID, u32 nPlaneID, SensorInitHandle pfnSensorInitHandle, void *pPrivateData);
+extern s32 DrvSensorRelease(u32 nSNRPadID);
+extern s32 DrvSensorEarlyInitSync(u32 nSNRPadID);
+extern s32 DrvRegisterSensorI2CSlaveID(u32 nCamID, u32 Slaveid);
+extern s32 DrvRegisterPlaneI2CSlaveID(u32 nCamID, u32 nPlaneID, u32 Slaveid);
+extern s32 DrvSensorHandleVer(u32 version_major, u32 version_minor);
+extern s32 DrvSensorIFVer(u32 version_major, u32 version_minor);
+extern s32 DrvSensorI2CVer(u32 version_major, u32 version_minor);
+#define DrvUnregisterSensorDriverEx(nSNRPadID) DrvSensorRelease((nSNRPadID))
+
+#define SENSOR_USLEEP(us) CamOsUsSleep(us)
+#define SENSOR_MSLEEP(ms) CamOsMsSleep(ms)
+#define SENSOR_UDELAY(us) CamOsUsDelay(us)
+#define SENSOR_MDELAY(ms) CamOsMsDelay(ms)
+#endif
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor_common.h b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor_common.h
new file mode 100644
index 00000000..88b2b38c
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor_common.h
@@ -0,0 +1,379 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifndef _SENSOR_OS_WRAPPER_H_
+#define _SENSOR_OS_WRAPPER_H_
+
+#if defined(__KERNEL__)
+#define CAM_OS_LINUX_KERNEL
+#endif
+
+#include <cam_os_wrapper.h>
+#include <drv_ms_cus_sensor.h>
+#include <drv_sensor.h>
+
+/******************************************************** RTK ***********************************************************/
+#if defined(CAM_OS_RTK)
+typedef unsigned char bool;
+#ifndef true
+#define true                        1
+#define false                       0
+#endif
+
+#ifndef _SENSOR_SLAVE_ID_
+#define _SENSOR_SLAVE_ID_ 0
+#endif
+
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN(NAME)
+
+#define SENSOR_DRV_ENTRY_IMPL_END(Name,LinearEntry,HdrSefEntry,HdrLefEntry)\
+int Name##_init_driver(unsigned char chmap)\
+{\
+    int nCamID=0;\
+    /*To avoid compile warning*/\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    for(nCamID=0;nCamID<4;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){ DrvRegisterSensorDriver(nCamID, LinearEntry);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p1){ DrvRegisterPlaneDriver(nCamID, 1, HdrSefEntry);\
+                DrvRegisterPlaneI2CSlaveID(nCamID, 1, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p2){ DrvRegisterPlaneDriver(nCamID, 0, HdrLefEntry);\
+                DrvRegisterPlaneI2CSlaveID(nCamID, 0, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+        }\
+    }\
+    return 0;\
+}
+
+static volatile int lane_num = 2;
+static volatile int hdr_lane_num=2;
+
+#define SENSOR_DRV_PARAM_MCLK() "NONE"
+#define SENSOR_USLEEP_(us) {CamOsUsDelay(us);}
+#define SENSOR_MSLEEP_(ms) {CamOsMsDelay(ms);}
+
+/*Extension version*/
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(NAME) SENSOR_DRV_ENTRY_IMPL_BEGIN(NAME)
+
+#define MAX_CAMID_LEN 4
+#define SENSOR_DRV_ENTRY_IMPL_END_EX(Name,LinearEntry,HdrSefEntry,HdrLefEntry,PrivateDataType)\
+static PrivateDataType* g_pData[2][MAX_CAMID_LEN] = {{0,0,0,0}, {0,0,0,0}};\
+static PrivateDataType g_PrivData[2][MAX_CAMID_LEN];\
+int Name##_init_driver(unsigned char chmap)\
+{\
+    int nCamID=0;\
+    /*To avoid compile warning*/\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){\
+                /*void* pData = CamOsMemAlloc(sizeof(PrivateDataType));*/\
+                void* pData = &g_PrivData[0][nCamID];/*Change private data to static var*/\
+                memset(pData,0,sizeof(PrivateDataType));\
+                DrvRegisterSensorDriverEx(nCamID, LinearEntry,pData);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+                g_pData[0][nCamID] = pData;\
+            }\
+            if(p1||p2){\
+                /*void* pData = CamOsMemAlloc(sizeof(PrivateDataType));*/\
+                void* pData = &g_PrivData[1][nCamID];/*Change private data to static var*/\
+                memset(pData,0,sizeof(PrivateDataType));\
+                if(p1){\
+                    DrvRegisterPlaneDriverEx(nCamID, 1, HdrSefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 1, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                    SENSOR_DMSG("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p2){\
+                    DrvRegisterPlaneDriverEx(nCamID, 0, HdrLefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 0, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                    SENSOR_DMSG("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                g_pData[1][nCamID] = pData;\
+            }\
+            DrvSensorEarlyInitSync(nCamID);\
+        }\
+    }\
+    return 0;\
+}\
+\
+int Name##_deinit_driver(unsigned char chmap)\
+{\
+    int nCamID=0;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(g_pData[0][nCamID] || g_pData[1][nCamID])\
+            {\
+                DrvUnregisterSensorDriverEx(nCamID);\
+                if(g_pData[0][nCamID]){\
+                    /*CamOsMemRelease((void*)g_pData[0][nCamID]);*/\
+                    g_pData[0][nCamID] = 0;\
+                }\
+                if(g_pData[1][nCamID]){\
+                    /*CamOsMemRelease((void*)g_pData[1][nCamID]);*/\
+                    g_pData[1][nCamID] = 0;\
+                }\
+            }\
+        }\
+    }\
+    return 0;\
+}
+/******************************************************** LINUX ***********************************************************/
+#elif defined(CAM_OS_LINUX_KERNEL)
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/string.h>
+#include <linux/delay.h>
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN(Name) \
+int chmap = 0;\
+module_param(chmap, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(chmap, "VIF channel mapping");\
+char *mclk = "use default parameter";\
+module_param(mclk, charp, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(mclk, "Assign MCLK");
+int lane_num = 2;\
+module_param(lane_num, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(lane_num, "sensor output lane number");
+int hdr_lane_num = 4;\
+module_param(hdr_lane_num, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(hdr_lane_num, "sensor output lane number");
+int i2c_slave_id = 0;\
+module_param(i2c_slave_id, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(i2c_slave_id, "sensor i2c slave id");
+
+#define SENSOR_DRV_ENTRY_IMPL_END(Name,LinearEntry,HdrSefEntry,HdrLefEntry) \
+static int __init Name##_init_driver(void)\
+{\
+    int nCamID=0;\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    if(DrvSensorHandleVer(CUS_CAMSENSOR_HANDLE_MAJ_VER, CUS_CAMSENSOR_HANDLE_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorIFVer(CUS_CAMSENSORIF_MAJ_VER, CUS_CAMSENSORIF_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorI2CVer(CUS_CAMSENSOR_I2C_MAJ_VER, CUS_CAMSENSOR_I2C_MIN_VER)==FAIL)\
+    return FAIL;\
+    for(nCamID=0;nCamID<4;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){ DrvRegisterSensorDriver(nCamID, LinearEntry);\
+            DrvRegisterSensorI2CSlaveID(nCamID, (i2c_slave_id>>(nCamID*8))&0xFF);\
+            pr_info("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p1){ DrvRegisterPlaneDriver(nCamID, 1, HdrSefEntry);\
+            DrvRegisterPlaneI2CSlaveID(nCamID, 1, (i2c_slave_id>>(nCamID*8))&0xFF);\
+            pr_info("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p2){ DrvRegisterPlaneDriver(nCamID, 0, HdrLefEntry);\
+            DrvRegisterPlaneI2CSlaveID(nCamID, 0, (i2c_slave_id>>(nCamID*8))&0xFF);\
+            pr_info("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+        }\
+    }\
+    return 0;\
+}\
+static void __exit Name##_exit_driver(void)\
+{\
+    pr_info("sensordrv exit");\
+}\
+subsys_initcall(Name##_init_driver);\
+module_exit(Name##_exit_driver);\
+MODULE_DESCRIPTION("Sensor_"#Name);\
+MODULE_AUTHOR("SigmaStar");\
+MODULE_LICENSE("Proprietary");
+
+#define SENSOR_DRV_PARAM_MCLK() (mclk)
+#define SENSOR_USLEEP_(us) CamOsUsSleep(us)
+#define SENSOR_MSLEEP_(ms) CamOsMsSleep(ms)
+
+/*Extension version*/
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(Name) SENSOR_DRV_ENTRY_IMPL_BEGIN(Name)
+
+#define MAX_CAMID_LEN 4
+#define SENSOR_DRV_ENTRY_IMPL_END_EX(Name,LinearEntry,HdrSefEntry,HdrLefEntry,PrivateDataType) \
+static PrivateDataType* g_pData[2][MAX_CAMID_LEN] = {{0,0,0,0}, {0,0,0,0}};\
+static int __init Name##_init_driver(void)\
+{\
+    int nCamID=0;\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    if(DrvSensorHandleVer(CUS_CAMSENSOR_HANDLE_MAJ_VER, CUS_CAMSENSOR_HANDLE_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorIFVer(CUS_CAMSENSORIF_MAJ_VER, CUS_CAMSENSORIF_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorI2CVer(CUS_CAMSENSOR_I2C_MAJ_VER, CUS_CAMSENSOR_I2C_MIN_VER)==FAIL)\
+    return FAIL;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                DrvRegisterSensorDriverEx(nCamID, LinearEntry,pData);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                pr_info("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+                g_pData[0][nCamID] = pData;\
+            }\
+            if(p1||p2){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                if(p1){\
+                    DrvRegisterPlaneDriverEx(nCamID, 1, HdrSefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 1, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p2){\
+                    DrvRegisterPlaneDriverEx(nCamID, 0, HdrLefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 0, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                g_pData[1][nCamID] = pData;\
+            }\
+        }\
+    }\
+    return 0;\
+}\
+static void __exit Name##_exit_driver(void)\
+{\
+    int nCamID=0;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(g_pData[0][nCamID] || g_pData[1][nCamID])\
+            {\
+                DrvUnregisterSensorDriverEx(nCamID);\
+                if(g_pData[0][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[0][nCamID]);\
+                    g_pData[0][nCamID] = 0;\
+                }\
+                if(g_pData[1][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[1][nCamID]);\
+                    g_pData[1][nCamID] = 0;\
+                }\
+            }\
+        }\
+    }\
+}\
+subsys_initcall(Name##_init_driver);\
+module_exit(Name##_exit_driver);\
+MODULE_DESCRIPTION("Sensor_"#Name);\
+MODULE_AUTHOR("SigmaStar");\
+MODULE_LICENSE("Proprietary");
+                
+//define 3 ch AHD application impl
+#define SENSOR_DRV_ENTRY_3CHAHD_IMPL_END_EX(Name,LinearEntry,AhdCh0Entry,AhdCh1Entry, AhdCh2Entry,PrivateDataType)\
+static PrivateDataType* g_pData[2][MAX_CAMID_LEN] = {{0,0,0,0}, {0,0,0,0}};\
+static int __init Name##_init_driver(void)\
+{\
+    int nCamID=0;\
+    void* p0 = LinearEntry;\
+    void* p1 = AhdCh0Entry;\
+    void* p2 = AhdCh1Entry;\
+    void* p3 = AhdCh2Entry;\
+    if(DrvSensorHandleVer(CUS_CAMSENSOR_HANDLE_MAJ_VER, CUS_CAMSENSOR_HANDLE_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorIFVer(CUS_CAMSENSORIF_MAJ_VER, CUS_CAMSENSORIF_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorI2CVer(CUS_CAMSENSOR_I2C_MAJ_VER, CUS_CAMSENSOR_I2C_MIN_VER)==FAIL)\
+    return FAIL;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                DrvRegisterSensorDriverEx(nCamID, LinearEntry,pData);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                pr_info("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+                g_pData[0][nCamID] = pData;\
+            }\
+            if(p1||p2||p3){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                if(p1){\
+                    DrvRegisterPlaneDriverEx(nCamID, 0, AhdCh0Entry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 0, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s AHD0 to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p2){\
+                    DrvRegisterPlaneDriverEx(nCamID, 1, AhdCh1Entry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 1, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s AHD1 to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p3){\
+                    DrvRegisterPlaneDriverEx(nCamID, 2, AhdCh2Entry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 2, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s AHD2 to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                g_pData[1][nCamID] = pData;\
+            }\
+        }\
+    }\
+    return 0;\
+}\
+static void __exit Name##_exit_driver(void)\
+{\
+    int nCamID=0;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(g_pData[0][nCamID] || g_pData[1][nCamID])\
+            {\
+                DrvUnregisterSensorDriverEx(nCamID);\
+                if(g_pData[0][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[0][nCamID]);\
+                    g_pData[0][nCamID] = 0;\
+                }\
+                if(g_pData[1][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[1][nCamID]);\
+                    g_pData[1][nCamID] = 0;\
+                }\
+            }\
+        }\
+    }\
+}\
+subsys_initcall(Name##_init_driver);\
+module_exit(Name##_exit_driver);\
+MODULE_DESCRIPTION("Sensor_"#Name);\
+MODULE_AUTHOR("SigmaStar");\
+MODULE_LICENSE("Proprietary");
+
+#endif //end of CAM_OS_LINUX_KERNEL
+
+
+#endif //endif _SENSOR_OS_WRAPPER_H_
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor_init_table.h b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor_init_table.h
new file mode 100644
index 00000000..10368d9e
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/drv_sensor_init_table.h
@@ -0,0 +1,114 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifndef _DRV_SENSOR_INIT_H_
+#define _DRV_SENSOR_INIT_H_
+
+//#define SENSOR_INIT_CMDQ_MODE
+#define SENSOR_INIT_DRV_MODE
+
+/* for sensor driver */
+#define I2C_1A1B_W(reg,val) {(reg),(val)}
+#define CMDQ_DELAY_MS(ms) {(0xFFFF),(ms)}
+
+#define I2CM_1A1D_W(slave_addr,reg,val) \
+        {(reg),(val)}
+
+#define I2CM_1A1D_W_BURST2(slave_addr,reg,d0,d1) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)}
+
+#define I2CM_1A1D_W_BURST3(slave_addr,reg,d0,d1,d2) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)}
+
+#define I2CM_1A1D_W_BURST4(slave_addr,reg,d0,d1,d2,d3) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)}
+
+#define I2CM_1A1D_W_BURST5(slave_addr,reg,d0,d1,d2,d3,d4) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)}
+
+#define I2CM_1A1D_W_BURST6(slave_addr,reg,d0,d1,d2,d3,d4,d5) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)},\
+        {(reg)+5,(d5)}
+
+#define I2CM_1A1D_W_BURST7(slave_addr,reg,d0,d1,d2,d3,d4,d5,d6) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)},\
+        {(reg)+5,(d5)},\
+        {(reg)+6,(d6)}
+
+#define I2CM_2A1D_W(slave_addr,reg,val) \
+        {(reg),(val)}
+
+#define I2CM_2A1D_W_BURST2(slave_addr,reg,d0,d1) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)}
+
+#define I2CM_2A1D_W_BURST3(slave_addr,reg,d0,d1,d2) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)}
+
+#define I2CM_2A1D_W_BURST4(slave_addr,reg,d0,d1,d2,d3) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)}
+
+#define I2CM_2A1D_W_BURST5(slave_addr,reg,d0,d1,d2,d3,d4) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)}
+
+#define I2CM_2A1D_W_BURST6(slave_addr,reg,d0,d1,d2,d3,d4,d5) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)},\
+        {(reg)+5,(d5)}
+
+#define I2CM_2A2D_W(slave_addr,reg,val) \
+        {(reg),(val)}
+
+#define I2CM_2A2D_W_BURST2(slave_addr,reg,d0,d1) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)}
+
+#define I2CM_2A2D_W_BURST3(slave_addr,reg,d0,d1,d2) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)}
+
+#define SENSOR_INIT_TABLE I2C_ARRAY
+
+#endif
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/sensor_i2c_api.h b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/sensor_i2c_api.h
new file mode 100644
index 00000000..4de7027c
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/include/sensor_i2c_api.h
@@ -0,0 +1,168 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+/*! @file isp_i2c_api.h
+      @brief This file contains Infinity ISP I2C basic API.
+*/
+
+/** @defgroup group1 ISP I2C API
+* @{
+*/
+#ifndef ISP_I2C_API_H
+#define ISP_I2C_API_H
+
+#define SENSOR_I2C_SUCCESS (0)
+#define SENSOR_I2C_FAIL (-1)
+#define SENSOR_I2C_NOT_SUPPORT (-2)
+
+/**@brief handle version info */
+typedef struct _version_info{
+    u16          major;
+    u16          minor;
+}__attribute__((packed, aligned(1))) version_info;
+
+/*! @brief I2C API handle.*/
+struct __i2c_handle_t;
+
+/*! @brief I2C batch read/write data.*/
+typedef struct _I2C_ARRAY{
+    u16 reg; /**< Register address.*/
+    u16 data; /**< Data.*/
+} I2C_ARRAY;
+
+/*! @brief I2C burst read/write data.*/
+typedef struct _I2C_ARRAY_BURST{
+    u16 reg; /**< Register address.*/
+    u16 *data; /**< Data.*/
+} I2C_ARRAY_BURST;
+
+/*! @brief I2C data direction*/
+typedef enum {
+    I2C_RW_R, /**< Data direction read.*/
+    I2C_RW_W,/**< Data direction write.*/
+} I2C_RW;
+
+/*! @brief Use for i2c_array_rw only */
+typedef struct _I2C_CPX_ARRAY{
+    I2C_RW  rw; /**< Data direction */
+    u16 reg; /**< Device register address */
+    u16 data; /**< Data write to device or read from device*/
+}__attribute__((packed, aligned(1))) I2C_CPX_ARRAY;
+
+/*! @brief Internal use for I2C API*/
+typedef enum {
+    I2C_FMT_A8D8, /**< 8 bits Address, 8 bits Data */
+    I2C_FMT_A16D8,/**< 16 bits Address 8 bits Data */
+    I2C_FMT_A8D16,/**< 8 bits Address 16 bits Data */
+    I2C_FMT_A16D16,/**< 16 bits Address 16 bits Data */
+    I2C_FMT_END/**< Reserved */
+} ISP_I2C_FMT;
+
+/*! @brief ISP_I2C_MODE Internal use for I2C API*/
+typedef enum {
+    I2C_LEGACY_MODE,    /**< Do not use */
+    I2C_NORMAL_MODE     /**< Sensor driver can only use I2C_NORMAL_MODE */
+} ISP_I2C_MODE;
+
+
+/*! @brief app_i2c_cfg I2C setting for sensor and bus.*/
+typedef struct _app_i2c_cfg{
+    ISP_I2C_MODE        mode;   //!< I2C_NORMAL_MODE only
+    ISP_I2C_FMT         fmt;        //!< I2C data format
+    u32                 speed;          //!< I2C clock in Hz
+    u16                 address;       //!< Sensor slave address , bit[7~1] are available, bit[0] user don't care
+    u16  reserved;
+}__attribute__((packed, aligned(1))) app_i2c_cfg;
+
+/*! @brief The interface of I2C APIs export to user*/
+typedef struct _i2c_handle_t {
+    //int version;
+    version_info version;
+    void *pdata; //i2c_private_data
+
+    u32 nSensorID;
+    /** @brief Open isp i2c port. This function must be called before using isp I2C  APIs.
+    Call i2c_close to close isp i2c port and allocated resource.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C initial configuration.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_open)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg);
+
+    /** @brief Close isp I2C port. Call this functon to release resource which allocated form i2c_open.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C configuration mode and spped are necessary in this stage.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_close)(struct _i2c_handle_t* handle );
+
+    /** @brief Write single data to device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] reg Device register address address width depend on cfg->fmt.
+    @param[in] data Data to write, data width depend on cfg->fmt.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_tx)(struct _i2c_handle_t* handle , app_i2c_cfg *cfg, u16 reg, u16 data);
+
+    /** @brief Read single data from device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] reg Device register address address width depend on cfg->fmt.
+    @param[out] data Data buffer for read, data width depend on cfg->fmt.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_rx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, u16 reg, volatile u16 *data);
+
+    /** @brief Batch write to device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] pdata Data array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_array_tx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY *pdata, u32 len);
+
+    /** @brief Burst write to device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] pdata Data array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_burst_tx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY_BURST *pdata, u32 len);
+
+    int (*i2c_burst_rx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY_BURST *pdata, u32 len);
+    /** @brief Batch read from device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[out] pdata Data array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_array_rx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY *pdata, u32 len);
+
+    /** @brief Composite batch read/write
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in][out] pdata Data description array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_array_rw)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_CPX_ARRAY *pdata, u32 len);
+} i2c_handle_t;
+
+/** @} */ // end of ISP I2C API
+
+#endif
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_gc2053_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_gc2053_mipi.c
new file mode 100644
index 00000000..277d75df
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_gc2053_mipi.c
@@ -0,0 +1,1291 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN(gc2053);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+//#define _DEBUG_
+//c11 extern int usleep(u32 usec);
+//int usleep(u32 usec);
+
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE_LINEAR CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (2)
+//#define SENSOR_MIPI_HDR_MODE (1) //0: Non-HDR mode. 1:Sony DOL mode
+//MIPI config end.
+//============================================
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+
+//#undef SENSOR_DBG
+#define SENSOR_DBG 0
+
+///////////////////////////////////////////////////////////////
+//          @@@                                                                                       //
+//       @   @@      ==  S t a r t * H e r e ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                           //
+//         @@@@                                                                                  //
+//                                                                                                     //
+//      Start Step 1 --  show preview on LCM                                         //
+//                                                                                               //
+//  Fill these #define value and table with correct settings                        //
+//      camera can work and show preview on LCM                                 //
+//                                                                                                       //
+///////////////////////////////////////////////////////////////
+
+#define SENSOR_ISP_TYPE     ISP_EXT                   //ISP_EXT, ISP_SOC
+#define F_number  22                                  // CFG, demo module
+//#define SENSOR_DATAFMT      CUS_DATAFMT_BAYER        //CUS_DATAFMT_YUV, CUS_DATAFMT_BAYER
+#define SENSOR_IFBUS_TYPE   CUS_SENIF_BUS_MIPI      //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE PACKET_HEADER_EDGE1
+#define SENSOR_DATAPREC     CUS_DATAPRECISION_10    //CFG //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE     CUS_SEN_10TO12_9000     //CFG
+#define SENSOR_BAYERID      CUS_BAYER_RG            //CFG //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_RGBIRID      CUS_RGBIR_NONE
+#define SENSOR_ORIT         CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+#define SENSOR_MAX_GAIN     128                 // max sensor again, a-gain
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+#define lane_number 2
+#define vc0_hs_mode 3   //0: packet header edge  1: line end edge 2: line start edge 3: packet footer edge
+#define long_packet_type_enable 0x00 //UD1~UD8 (user define)
+
+#define Preview_MCLK_SPEED  CUS_CMU_CLK_27MHZ        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+//#define Preview_line_period 30000                  ////HTS/PCLK=4455 pixels/148.5MHZ=30usec @MCLK=36MHz
+//#define vts_30fps 1125//1346,1616                 //for 29.1fps @ MCLK=36MHz
+#define Preview_line_period 29630//30580                  //(36M/37.125M)*30fps=29.091fps(34.375msec), hts=34.375/1125=30556,
+//#define Line_per_second     32727
+#define vts_30fps  1125//1266//1150//1090                              //for 29.091fps @ MCLK=36MHz
+#define Prv_Max_line_number 2200                    //maximum exposure line munber of sensor when preview
+#define Preview_WIDTH       1920                    //resolution Width when preview
+#define Preview_HEIGHT      1080                    //resolution Height when preview
+#define Preview_MAX_FPS     30                     //fastest preview FPS
+#define Preview_MIN_FPS     5                      //slowest preview FPS
+#define Preview_CROP_START_X     0                      //CROP_START_X
+#define Preview_CROP_START_Y     0                      //CROP_START_Y
+
+#define SENSOR_I2C_ADDR    0x6E                   //I2C slave address
+#define SENSOR_I2C_SPEED   200000 //300000// 240000                  //I2C speed, 60000~320000
+
+#define SENSOR_I2C_LEGACY  I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT     I2C_FMT_A8D8        //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL     CUS_CLK_POL_POS        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL      CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+
+#define SENSOR_VSYNC_POL    CUS_CLK_POL_NEG        // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL    CUS_CLK_POL_NEG        // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL     CUS_CLK_POL_POS        // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+int blk_flag=1;
+int times = 0;
+//static int  drv_Fnumber = 22;
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+CUS_MCLK_FREQ UseParaMclk(void);
+
+CUS_CAMSENSOR_CAP sensor_cap = {
+    .length = sizeof(CUS_CAMSENSOR_CAP),
+    .version = 0x0001,
+};
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        u32 sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 line;
+    } expo;
+
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool dirty;
+    bool orient_dirty;
+} gc2053_params;
+// set sensor ID address and data,
+
+/* typedef struct {
+    unsigned int total_gain;
+    unsigned short reg_val;
+} Gain_ARRAY;
+ */
+static I2C_ARRAY Sensor_id_table[] =
+{
+{0xf0, 0x20},      // {address of ID, ID },
+{0xf1, 0x53},
+};
+
+typedef struct {
+
+      u32 gain;
+      unsigned short again_reg_val_0;
+      unsigned short again_reg_val_1;
+      unsigned short again_reg_val_2;
+      unsigned short again_reg_val_3;
+
+} Gain_ARRAY;
+
+static I2C_ARRAY Sensor_init_table[] =
+{
+                        /****system****/
+{0xfe, 0x80},
+{0xfe, 0x80},
+{0xfe, 0x80},
+{0xfe, 0x00},
+{0xf2, 0x00},//[1]I2C_open_ena [0]pwd_dn
+{0xf3, 0x00},//0f//00[3]Sdata_pad_io [2:0]Ssync_pad_io
+{0xf4, 0x36},//[6:4]pll_ldo_set
+{0xf5, 0xc0},//[7]soc_mclk_enable [6]pll_ldo_en [5:4]cp_clk_sel [3:0]cp_clk_div
+{0xf6, 0x44},//[7:3]wpllclk_div [2:0]refmp_div
+{0xf7, 0x01},//[7]refdiv2d5_en [6]refdiv1d5_en [5:4]scaler_mode [3]refmp_enb [1]div2en [0]pllmp_en
+{0xf8, 0x2c},//[7:0]pllmp_div
+{0xf9, 0x42},//[7:3]rpllclk_div [2:1]pllmp_prediv [0]analog_pwc
+{0xfc, 0x8e},                           /****CISCTL & ANALOG****/
+{0xfe, 0x00},
+{0x87, 0x18},//[6]aec_delay_mode
+{0xee, 0x30},//[5:4]dwen_sramen
+{0xd0, 0xb7},//ramp_en
+{0x03, 0x04},
+{0x04, 0x60},
+{0x05, 0x04},//05
+{0x06, 0x4c},//60//[11:0]hb
+{0x07, 0x00},
+{0x08, 0x19},
+{0x09, 0x00},
+{0x0a, 0x02}, //cisctl row start
+{0x0b, 0x00},
+{0x0c, 0x02}, //cisctl col start
+{0x0d, 0x04},
+{0x0e, 0x40},
+{0x12, 0xe2}, //vsync_ahead_mode
+{0x13, 0x16},
+{0x19, 0x0a}, //ad_pipe_num
+{0x21, 0x1c},//eqc1fc_eqc2fc_sw
+{0x28, 0x0a},//16//eqc2_c2clpen_sw
+{0x29, 0x24},//eq_post_width
+{0x2b, 0x04},//c2clpen --eqc2
+{0x32, 0xf8}, //[5]txh_en ->avdd28
+{0x37, 0x03}, //[3:2]eqc2sel=0
+{0x39, 0x15},//17 //[3:0]rsgl
+{0x43, 0x07},//vclamp
+{0x44, 0x40}, //0e//post_tx_width
+{0x46, 0x0b},
+{0x4b, 0x20}, //rst_tx_width
+{0x4e, 0x08}, //12//ramp_t1_width
+{0x55, 0x20}, //read_tx_width_pp
+{0x66, 0x05}, //18//stspd_width_r1
+{0x67, 0x05}, //40//5//stspd_width_r
+{0x77, 0x01}, //dacin offset x31
+{0x78, 0x00}, //dacin offset
+{0x7c, 0x93}, //[1:0] co1comp
+{0x8c, 0x12}, //12 ramp_t1_ref
+{0x8d, 0x92},//90
+{0x90, 0x00},
+{0x9d, 0x10},
+{0xce, 0x7c},//70//78//[4:2]c1isel
+{0xd2, 0x41},//[5:3]c2clamp
+{0xd3, 0xdc},//ec//0x39[7]=0,0xd3[3]=1 rsgh=vref
+{0xe6, 0x50},//ramps offset                 /*gain*/
+{0xb6, 0xc0},
+{0xb0, 0x70},
+{0xb1, 0x01},
+{0xb2, 0x00},
+{0xb3, 0x00},
+{0xb4, 0x00},
+{0xb8, 0x01},
+{0xb9, 0x00},
+/*blk*/
+{0x26, 0x30},//23
+{0xfe, 0x01},
+{0x40, 0x23},
+{0x55, 0x07},
+{0x58, 0x00},//random noise disable
+
+{0x60, 0x40}, //[7:0]WB_offset
+{0xfe, 0x04},
+{0x14, 0x78}, //g1 ratio
+{0x15, 0x78}, //r ratio
+{0x16, 0x78}, //b ratio
+{0x17, 0x78}, //g2 ratio
+/*window*/
+{0xfe, 0x01},
+{0x92, 0x00}, //win y1
+{0x94, 0x03}, //win x1
+{0x95, 0x04},
+{0x96, 0x38}, //[10:0]out_height
+{0x97, 0x07},
+{0x98, 0x80}, //[11:0]out_width
+/*ISP*/
+{0xfe, 0x01},
+{0x58, 0x00},
+{0x01, 0x05},//03//[3]dpc blending mode [2]noise_mode [1:0]center_choose 2b'11:median 2b'10:avg 2'b00:near
+{0x02, 0x89}, //[7:0]BFF_sram_mode
+{0x04, 0x01}, //[0]DD_en
+{0x07, 0xa6},
+{0x08, 0xa9},
+{0x09, 0xa8},
+{0x0a, 0xa7},
+{0x0b, 0xff},
+{0x0c, 0xff},
+{0x0f, 0x00},
+{0x50, 0x1c},
+{0x89, 0x03},
+{0xfe, 0x04},
+{0x28, 0x86},//84
+{0x29, 0x86},//84
+{0x2a, 0x86},//84
+{0x2b, 0x68},//84
+{0x2c, 0x68},//84
+{0x2d, 0x68},//84
+{0x2e, 0x68},//83
+{0x2f, 0x68},//82
+{0x30, 0x4f},//82
+{0x31, 0x68},//82
+{0x32, 0x67},//82
+{0x33, 0x66},//82
+{0x34, 0x66},//82
+{0x35, 0x66},//82
+{0x36, 0x66},//64
+{0x37, 0x66},//68
+{0x38, 0x62},
+{0x39, 0x62},
+{0x3a, 0x62},
+{0x3b, 0x62},
+{0x3c, 0x62},
+{0x3d, 0x62},
+{0x3e, 0x62},
+{0x3f, 0x62},
+/****DVP & MIPI****/
+{0xfe, 0x01},
+{0x9a, 0x06},//[5]OUT_gate_mode [4]hsync_delay_half_pclk [3]data_delay_half_pclk [2]vsync_polarity [1]hsync_polarity [0]pclk_out_polarity
+{0xfe, 0x00},
+{0x7b, 0x2a},//[7:6]updn [5:4]drv_high_data [3:2]drv_low_data [1:0]drv_pclk
+{0x23, 0x2d},//[3]rst_rc [2:1]drv_sync [0]pwd_rc
+{0xfe, 0x03},
+{0x01, 0x27},//20//27[6:5]clkctr [2]phy-lane1_en [1]phy-lane0_en [0]phy_clk_en
+{0x02, 0x56},//[7:6]data1ctr [5:4]data0ctr [3:0]mipi_diff
+{0x03, 0xb6},//b2//b6[7]clklane_p2s_sel [6:5]data0hs_ph [4]data0_delay1s [3]clkdelay1s [2]mipi_en [1:0]clkhs_ph
+{0x12, 0x80},
+{0x13, 0x07},//LWC
+{0x15, 0x12},//[1:0]clk_lane_mode
+{0xfe, 0x00},
+{0x3e, 0x91},//40//91[7]lane_ena [6]DVPBUF_ena [5]ULPEna [4]MIPI_ena [3]mipi_set_auto_disable [2]RAW8_mode [1]ine_sync_mode [0]double_lane_en
+
+};
+
+I2C_ARRAY TriggerStartTbl[] = {
+//{0x30f4,0x00},//Master mode start
+};
+
+I2C_ARRAY PatternTbl[] = {
+    //pattern mode
+};
+
+I2C_ARRAY Current_Mirror_Flip_Tbl[] = {
+     {0x17, 0x80},    // bit[1:0]
+};
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@                                                                                    //
+//                 @@                                                                                    //
+//             @@@                                                                                      //
+//       @       @@                                                                                    //
+//         @@@@                                                                                        //
+//                                                                                                          //
+//      Step 3 --  complete camera features                                              //
+//                                                                                                         //
+//                                                                                                         //
+//  camera set EV, MWB, orientation, contrast, sharpness                          //
+//   , saturation, and Denoise can work correctly.                                     //
+//                                                                                                          //
+/////////////////////////////////////////////////////////////////
+
+
+static I2C_ARRAY mirr_flip_table[] =
+{
+    #if 0
+     {0x17, 0x83},    // bit[1:0]
+
+     {0x17, 0x82},    // bit[1:0]
+
+     {0x17, 0x81},    // bit[1:0]
+
+     {0x17, 0x80},    // bit[1:0]
+    #endif
+     {0x17, 0x80},    // bit[1:0]
+
+     {0x17, 0x81},    // bit[1:0]
+
+     {0x17, 0x82},    // bit[1:0]
+
+     {0x17, 0x83},    // bit[1:0]
+
+};
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+
+static int g_sensor_ae_min_gain = 1024;//1280;
+
+static I2C_ARRAY gain_reg[] = {
+    {0xfe, 0x00},
+    {0xb4, 0x00},
+    {0xb3, 0x00},
+    {0xb8, 0x00},
+    {0xb9, 0x00},
+    {0xb1, 0x00},
+    {0xb2, 0x00},
+};
+
+
+static I2C_ARRAY expo_reg[] = {
+    {0x04, 0xd0},
+    {0x03, 0x05},
+};
+
+
+static I2C_ARRAY vts_reg[] = {
+    {0x41, 0x05},
+    {0x42, 0xdc},
+
+};
+
+I2C_ARRAY temperature_reg[] = {
+    {0x0c, 0x30},
+    {0x0d, 0x30},
+    {0x0e, 0x30},
+    {0x0f, 0x30},
+};
+
+static Gain_ARRAY gain_table[]={
+                                {1024 , 0x00, 0x00,0x01,0x00},
+                                {1230 , 0x00, 0x10,0x01,0x0c},
+                                {1440 , 0x00, 0x20,0x01,0x1b},
+                                {1730 , 0x00, 0x30,0x01,0x2c},
+                                {2032 , 0x00, 0x40,0x01,0x3f},
+                                {2380 , 0x00, 0x50,0x02,0x16},
+                                {2880 , 0x00, 0x60,0x02,0x35},
+                                {3460 , 0x00, 0x70,0x03,0x16},
+                                {4080 , 0x00, 0x80,0x04,0x02},
+                                {4800 , 0x00, 0x90,0x04,0x31},
+                                {5776 , 0x00, 0xa0,0x05,0x32},
+                                {6760 , 0x00, 0xb0,0x06,0x35},
+                                {8064 , 0x00, 0xc0,0x08,0x04},
+                                {9500 , 0x00, 0x5a,0x09,0x19},
+                                {11552, 0x00, 0x83,0x0b,0x0f},
+                                {13600, 0x00, 0x93,0x0d,0x12},
+                                {16132, 0x00, 0x84,0x10,0x00},
+                                {18912, 0x00, 0x94,0x12,0x3a},
+                                {22528, 0x01, 0x2c,0x1a,0x02},
+                                {27036, 0x01, 0x3c,0x1b,0x20},
+                                {32340, 0x00, 0x8c,0x20,0x0f},
+                                {38256, 0x00, 0x9c,0x26,0x07},
+                                {45600, 0x02, 0x64,0x36,0x21},
+                                {53912, 0x02, 0x74,0x37,0x3a},
+                                {63768, 0x00, 0xc6,0x3d,0x02},
+                                {76880, 0x00, 0xdc,0x3f,0x3f},
+                                {92300, 0x02, 0x85,0x3f,0x3f},
+                                {108904, 0x02, 0x95,0x3f,0x3f},
+                                {123568, 0x00, 0xce,0x3f,0x3f},
+};
+
+#if 0
+static CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////// function definition ///////////////////
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) SENSOR_DMSG(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+#define SENSOR_DMSG(args...) SENSOR_DMSG(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+#undef SENSOR_NAME
+#define SENSOR_NAME gc2053
+
+
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle);
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+
+//static u32 timeGetTimeU(void)
+//{
+//    CamOsTimespec_t tRes;
+//    CamOsGetMonotonicTime(&tRes);
+//    return (tRes.nSec * 1000000)+(tRes.nNanoSec/1000);
+//}
+//static u32 TStart = 0;
+
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    //TStart = timeGetTimeU();
+    /*PAD and CSI*/
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);   ///???
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);  ///???
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);    //=========   ????
+
+    /*Power ON*/
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    SENSOR_USLEEP(1000);
+
+    /*Reset PIN*/
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    SENSOR_USLEEP(1000);
+    SENSOR_DMSG("[%s] reset high\n", __FUNCTION__);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+
+    /*MCLK ON*/
+    sensor_if->MCLK(idx, 1, handle->mclk);
+     SENSOR_USLEEP(5000);
+    //CamOsPrintf("pCus_poweron = %d us \n",timeGetTimeU()-TStart);
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] power low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    //handle->i2c_bus->i2c_close(handle->i2c_bus);
+    SENSOR_USLEEP(1000);
+    //Set_csi_if(0, 0);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+    SensorReg_Write(0xfe,0x00);
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8) table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>2) return FAIL;
+
+      if( SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+          break;
+      else
+          continue;
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+      if( id_from_sensor[i].data != Sensor_id_table[i].data )
+        return FAIL;
+      //*id = id_from_sensor[i].data;
+      *id = ((*id)+ id_from_sensor[i].data)<<8;
+    }
+
+    *id >>= 8;
+    SENSOR_DMSG("[%s]gc2053 Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    //SENSOR_DMSG("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+
+    return SUCCESS;
+}
+
+static int gc2053_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+
+    SENSOR_DMSG("\n\n[%s], mode=%d \n", __FUNCTION__, mode);
+
+    return SUCCESS;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+//static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain);
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+static int pCus_init(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+    //TStart = timeGetTimeU();
+
+        for(i=0;i< ARRAY_SIZE(Sensor_init_table);i++)
+        {
+            if(Sensor_init_table[i].reg==0xffff)
+            {
+                msleep(Sensor_init_table[i].data);
+            }
+            else
+            {
+                cnt = 0;
+                while(SensorReg_Write(Sensor_init_table[i].reg,Sensor_init_table[i].data) != SUCCESS)
+                {
+                    cnt++;
+                    //SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                    if(cnt>=10)
+                    {
+                        //SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                        return FAIL;
+                    }
+                    msleep(10);
+                }
+            }
+        }
+
+/*
+        for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+        {
+            if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+            {
+                //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                return FAIL;
+            }
+        }
+*/
+
+    pCus_SetAEGain(handle,1024); //Set sensor gain = 1x
+    pCus_SetAEUSecs(handle, 30000);
+    pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+
+    //CamOsPrintf("pCus_init = %d us \n",timeGetTimeU()-TStart);
+
+    return SUCCESS;
+}
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init;
+            break;
+
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit) {
+    short HFlip;//,VFlip;
+
+    SensorReg_Write(0xfe,0x00);//page 0
+    SensorReg_Read(0x17, &HFlip);
+  //  SensorReg_Read(0x1d, &VFlip);
+
+    if(((HFlip&0x03)==0x03)) //&&((VFlip&0x80)==0))
+       *orit = CUS_ORIT_M0F0;
+    else if(((HFlip&0x03)==0x02)) //&&((VFlip&0x80)==0))
+       *orit = CUS_ORIT_M1F0;
+    else if(((HFlip&0x03)==0x01)) //&&((VFlip&0x80)!=0))
+       *orit = CUS_ORIT_M0F1;
+    else if(((HFlip&0x03)==0x00)) //&&((VFlip&0x80)!=0))
+       *orit = CUS_ORIT_M1F1;
+
+    //SENSOR_DMSG("mirror:%x\r\n", HFlip&0x80);
+    //SENSOR_DMSG("Flip:%x\r\n", VFlip&0x80);
+
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit) {
+    //gc2053_params *params = (gc2053_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            SensorReg_Write(0xfe,0x00);//page 0
+            SensorReg_Write(mirr_flip_table[0].reg,mirr_flip_table[0].data);
+            Current_Mirror_Flip_Tbl[0].reg = mirr_flip_table[0].reg;
+            Current_Mirror_Flip_Tbl[0].data = mirr_flip_table[0].data;
+         //  handle->bayer_id=  CUS_BAYER_BG;
+            break;
+        case CUS_ORIT_M1F0:
+            SensorReg_Write(0xfe,0x00);//page 0
+            SensorReg_Write(mirr_flip_table[1].reg,mirr_flip_table[1].data);
+            Current_Mirror_Flip_Tbl[0].reg = mirr_flip_table[1].reg;
+            Current_Mirror_Flip_Tbl[0].data = mirr_flip_table[1].data;
+    //  handle->bayer_id= CUS_BAYER_BG;
+            break;
+        case CUS_ORIT_M0F1:
+            SensorReg_Write(0xfe,0x00);//page 0
+            SensorReg_Write(mirr_flip_table[2].reg,mirr_flip_table[2].data);
+            Current_Mirror_Flip_Tbl[0].reg = mirr_flip_table[2].reg;
+            Current_Mirror_Flip_Tbl[0].data = mirr_flip_table[2].data;
+     // handle->bayer_id= CUS_BAYER_GR;
+            break;
+        case CUS_ORIT_M1F1:
+            SensorReg_Write(0xfe,0x00);//page 0
+            SensorReg_Write(mirr_flip_table[3].reg,mirr_flip_table[3].data);
+            Current_Mirror_Flip_Tbl[0].reg = mirr_flip_table[3].reg;
+            Current_Mirror_Flip_Tbl[0].data = mirr_flip_table[3].data;
+     // handle->bayer_id= CUS_BAYER_GR;
+            break;
+        default :
+            SensorReg_Write(0xfe,0x00);//page 0
+            SensorReg_Write(mirr_flip_table[0].reg,mirr_flip_table[0].data);
+            Current_Mirror_Flip_Tbl[0].reg = mirr_flip_table[0].reg;
+            Current_Mirror_Flip_Tbl[0].data = mirr_flip_table[0].data;
+    //  handle->bayer_id= CUS_BAYER_BG;
+            break;
+    }
+    //SensorReg_Write(0xef,0x01);
+ //   SensorReg_Write(0x09,1);
+
+   // params->orient_dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    gc2053_params *params = (gc2053_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = vts_reg[0].data << 8 | vts_reg[1].data ;
+
+    if (params->expo.fps >= 5000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return  params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    int vts=0;
+    gc2053_params *params = (gc2053_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    //return SUCCESS;
+
+    if(fps>=5 && fps <= 30){
+      params->expo.fps = fps;
+      params->expo.vts=  (vts_30fps*30)/fps;
+    }else if(fps>=5000 && fps <= 30000){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*30000)/fps;
+    }else{
+      //params->expo.vts=vts_30fps;
+      //params->expo.fps=30;
+      //SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+      return FAIL;
+    }
+
+    if ((params->expo.line) > (params->expo.vts)-4) {
+        vts = params->expo.line + 4;
+    }else
+        vts = params->expo.vts;
+    vts_reg[0].data = (vts >> 8) & 0x003f;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap) {
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status){
+    gc2053_params *params = (gc2053_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+
+        break;
+        case CUS_FRAME_ACTIVE:
+        if(params->dirty)
+        {
+            SensorRegArrayW((I2C_ARRAY*)gain_reg, ARRAY_SIZE(gain_reg));
+            SensorRegArrayW((I2C_ARRAY*)expo_reg, ARRAY_SIZE(expo_reg));
+            SensorRegArrayW((I2C_ARRAY*)vts_reg, ARRAY_SIZE(vts_reg));
+            params->dirty = false;
+        }
+        break;
+        default :
+        break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us) {
+//    gc2053_params *params = (gc2053_params *)handle->private_data;
+    u32 lines = 0;
+
+    lines  = (u32)(expo_reg[0].data&0xff);
+    lines |= (u32)(expo_reg[1].data&0x3f)<<8;
+
+    *us = (lines*Preview_line_period)/1000;
+
+
+    SENSOR_DMSG("[%s] sensor expo lines/us %ld,%ld us\n", __FUNCTION__, lines, *us);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us) {
+    u32 lines = 0, vts = 0;
+    gc2053_params *params = (gc2053_params *)handle->private_data;
+
+    lines=(1000*us)/Preview_line_period;
+
+    if(lines<1) lines=1;
+    if (lines > params->expo.vts-4) {
+        vts = lines + 4;
+    }else
+        vts = params->expo.vts;
+
+    params->expo.line = lines;
+    SENSOR_DMSG("[%s] us %ld, lines %ld, vts %ld\n", __FUNCTION__,
+                us,
+                lines,
+                params->expo.vts
+                );
+
+    expo_reg[0].data = (lines) & 0x00ff;
+    expo_reg[1].data = (lines>>8) & 0x003f;
+    vts_reg[0].data = (vts >> 8) & 0x003f;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain) {
+  //  gc2053_params *params = (gc2053_params *)handle->private_data;
+
+    u32 Again_0 = 1, Dgain_0 = 1;
+    u8 i;
+    u32  Fine_again = 1024;
+
+
+    for(i = 0;i < sizeof(gain_table)/sizeof(Gain_ARRAY);i++ )
+        {
+            if(( gain_table[i].again_reg_val_0 ==gain_reg[1].data) && (gain_table[i].again_reg_val_1 ==gain_reg[2].data))
+            {
+                Fine_again = gain_table[i].gain;
+                break;
+            }
+        }
+
+     Dgain_0 = (gain_reg[5].data & 0xf) * 64 + (gain_reg[6].data >> 2);
+     Again_0 = Fine_again;
+     *gain =(u32)((Again_0 * Dgain_0)/64);
+
+
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain) {
+
+    gc2053_params *params = (gc2053_params *)handle->private_data;
+    u32 dgain = 1;
+    u8 dgain_0 = 1, dgain_1 = 0;
+    u8 i = 0,tmp = 0;
+    int temperature_value = 0;
+    params->expo.final_gain = gain;
+
+    if (gain < 1024) {
+        gain = 1024;
+    } else if (gain > SENSOR_MAX_GAIN  * 1024) {
+        gain = SENSOR_MAX_GAIN  * 1024;
+    }
+
+    if(0 == times % 4)
+    {
+    SensorReg_Write(0xfe, 0x04);
+    SensorReg_Read(0x0c,&temperature_reg[0].data);
+    SensorReg_Read(0x0d,&temperature_reg[1].data);
+    SensorReg_Read(0x0e,&temperature_reg[2].data);
+    SensorReg_Read(0x0f,&temperature_reg[3].data);
+    SensorReg_Write(0xfe, 0x00);
+     if(times > 20)
+      {
+          times = 0;
+      }
+    }
+    temperature_value = (temperature_reg[0].data + temperature_reg[1].data + temperature_reg[2].data + temperature_reg[3].data) >> 2;
+
+        if(temperature_value >= 0x64)
+        {
+            if(gain > gain_table[16].gain)
+            {
+                tmp = 16;
+                blk_flag=2;
+            }
+            else
+            {
+              for(i = 0;i < 16;i++ )
+              {
+                if((gain >= gain_table[i].gain) && (gain < gain_table[i + 1].gain))
+                {
+                    tmp = i;
+                    blk_flag=2;
+                    break;
+                }
+              }
+            }
+         }
+         else if(temperature_value <= 0x18)
+        {
+
+                for(i = 0;i < sizeof(gain_table)/sizeof(Gain_ARRAY) - 1;i++ )
+                {
+                    if((gain >= gain_table[i].gain) && (gain < gain_table[i + 1].gain))
+                    {
+                        tmp = i;
+                        blk_flag=1;
+                        break;
+                    }
+                    else
+                    {
+                        blk_flag=1;
+                        tmp = sizeof(gain_table)/sizeof(Gain_ARRAY) -1;
+                    }
+                }
+        }
+            else
+        {
+            if(blk_flag==2)
+            {
+                if(gain >= gain_table[16].gain)
+                {
+                //gain = gain_table[16].gain;
+                tmp = 16;
+                }
+               else
+              {
+                for(i = 0;i < 16;i++ )
+                {
+                    if((gain >= gain_table[i].gain) && (gain < gain_table[i + 1].gain))
+                    {
+                    tmp = i;
+                    break;
+                   }
+                }
+              }
+            }
+            if(blk_flag==1)
+            {
+
+                for(i = 0;i < sizeof(gain_table)/sizeof(Gain_ARRAY) - 1;i++ )
+                {
+                    if((gain >= gain_table[i].gain) && (gain < gain_table[i + 1].gain))
+                    {
+                        tmp = i;
+                        break;
+                    }
+                    else
+                    {
+                        blk_flag=1;
+                        tmp = sizeof(gain_table)/sizeof(Gain_ARRAY) - 1;
+                    }
+                }
+            }
+        }
+
+
+    dgain =(gain*64)/(gain_table[tmp].gain);
+    dgain_0 = (dgain)>>6;
+    dgain_1 =(dgain & 0x3f)<<2;
+    gain_reg[1].data  = gain_table[tmp].again_reg_val_0;
+    gain_reg[2].data  = gain_table[tmp].again_reg_val_1;
+    gain_reg[3].data  = gain_table[tmp].again_reg_val_2;
+    gain_reg[4].data  = gain_table[tmp].again_reg_val_3;
+
+    gain_reg[5].data  = dgain_0;
+    gain_reg[6].data  = dgain_1;
+
+
+    SENSOR_DMSG("[%s] set gain/regH/regL=%d/0x%x/0x%x\n", __FUNCTION__, gain,gain_reg[1].data,gain_reg[2].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min = 1;//30
+    *max = 1000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min =handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN*1024;
+    return SUCCESS;
+}
+
+static int gc2053_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min =  Preview_line_period*1;//2
+    info->step = Preview_line_period*1;//2
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+  //  u32 i, j;
+/*
+    for(i=0,j=0;i< num ;i++,j+=2){
+        gain_gap_compensate[i].gain=pArray[i].gain;
+        gain_gap_compensate[i].offset=pArray[i].offset;
+    }
+    //SENSOR_DMSG("[%s]%d, %d, %d, %d\n", __FUNCTION__, num, pArray[0].gain, pArray[1].gain, pArray[num-1].offset);
+*/
+    return SUCCESS;
+}
+
+static int cus_camsensor_init_handle(ms_cus_sensor* drv_handle) {
+   ms_cus_sensor *handle = drv_handle;
+    gc2053_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    handle->private_data = CamOsMemCalloc(1, sizeof(gc2053_params));
+    params = (gc2053_params *)handle->private_data;
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    strcpy(handle->model_id,"gc2053_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0;
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= 0;
+    handle->video_res_supported.res[0].crop_start_y= 0;
+    handle->video_res_supported.res[0].nOutputWidth= 1920;
+    handle->video_res_supported.res[0].nOutputHeight= 1080;
+    SENSOR_DMSG(handle->video_res_supported.res[0].strResDesc, "1920x1080@30fps");
+
+    // i2c
+
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 2;
+    handle->ae_shutter_delay    = 2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 1;
+
+    ///calibration
+    handle->sat_mingain=g_sensor_ae_min_gain;
+
+
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init    ;
+
+    handle->pCus_sensor_poweron     = pCus_poweron ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = gc2053_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+     //sensor calibration
+//    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = gc2053_GetShutterInfo;
+    params->expo.vts=vts_30fps;
+    params->expo.fps = 30;
+    params->expo.line = 100;
+    params->dirty = false;
+    params->orient_dirty = false;
+    return SUCCESS;
+}
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle) {
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    //sensor_if->SetCSI_Clk(handle,CUS_CSI_CLK_DISABLE);
+    if (handle && handle->private_data) {
+        SENSOR_DMSG("[%s] release handle, handle %x, private data %x",
+                __FUNCTION__,
+                (int)handle,
+                (int)handle->private_data);
+        CamOsMemRelease(handle->private_data);
+        handle->private_data = NULL;
+    }
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END(  gc2053,
+                            cus_camsensor_init_handle,
+                            NULL,
+                            NULL
+                         );
+
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_gc4653_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_gc4653_mipi.c
new file mode 100644
index 00000000..4383e79a
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_gc4653_mipi.c
@@ -0,0 +1,1108 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(gc4653);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE_LINEAR CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (2)
+//#define SENSOR_MIPI_HDR_MODE (1) //0: Non-HDR mode. 1:Sony DOL mode
+//MIPI config end.
+//============================================
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+
+//#undef SENSOR_DBG
+#define SENSOR_DBG 0
+
+#define SENSOR_ISP_TYPE     ISP_EXT                 //ISP_EXT, ISP_SOC
+#define SENSOR_IFBUS_TYPE   CUS_SENIF_BUS_MIPI     //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE PACKET_HEADER_EDGE1
+#define SENSOR_DATAPREC     CUS_DATAPRECISION_10    //CFG //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE     CUS_SEN_10TO12_9000     //CFG
+#define SENSOR_BAYERID      CUS_BAYER_GR            //CFG //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_RGBIRID      CUS_RGBIR_NONE
+#define SENSOR_ORIT         CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+#define SENSOR_MAX_GAIN     (77660)/100                 // max sensor again, a-gain
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+#define lane_number 2
+#define vc0_hs_mode 3   //0: packet header edge  1: line end edge 2: line start edge 3: packet footer edge
+#define long_packet_type_enable 0x00 //UD1~UD8 (user define)
+
+#define Preview_MCLK_SPEED  CUS_CMU_CLK_27MHZ        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+#define Preview_line_period 22222//30580                  //(36M/37.125M)*30fps=29.091fps(34.375msec), hts=34.375/1125=30556,
+//#define Line_per_second     32727
+#define vts_30fps  1500//1266//1150//1090                              //for 29.091fps @ MCLK=36MHz
+//#define Prv_Max_line_number 2200                    //maximum exposure line munber of sensor when preview
+#define Preview_WIDTH       2560                    //resolution Width when preview
+#define Preview_HEIGHT      1440                    //resolution Height when preview
+#define Preview_MAX_FPS     30                     //fastest preview FPS
+#define Preview_MIN_FPS     5                      //slowest preview FPS
+#define Preview_CROP_START_X     0                      //CROP_START_X
+#define Preview_CROP_START_Y     0                      //CROP_START_Y
+
+#define SENSOR_I2C_ADDR    0x52                   //I2C slave address
+#define SENSOR_I2C_SPEED   200000 //300000// 240000                  //I2C speed, 60000~320000
+
+#define SENSOR_I2C_LEGACY  I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT     I2C_FMT_A16D8        //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL     CUS_CLK_POL_POS        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL      CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+
+#define SENSOR_VSYNC_POL    CUS_CLK_POL_NEG        // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL    CUS_CLK_POL_NEG        // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL     CUS_CLK_POL_POS        // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+CUS_MCLK_FREQ UseParaMclk(void);
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        u32 sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 line;
+    } expo;
+
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool dirty;
+    bool orient_dirty;
+    I2C_ARRAY tVts_reg[2];
+    I2C_ARRAY tGain_reg[7];
+    I2C_ARRAY tExpo_reg[2];
+    I2C_ARRAY tMirror_reg[1];
+} gc4653_params;
+// set sensor ID address and data,
+
+/* typedef struct {
+    unsigned int total_gain;
+    unsigned short reg_val;
+} Gain_ARRAY;
+ */
+const static I2C_ARRAY Sensor_id_table[] =
+{
+    {0x03f0, 0x46},     // {address of ID, ID },
+    {0x03f1, 0x53},
+};
+
+typedef struct {
+      u32 gain;
+      unsigned short again_reg_val_0;
+      unsigned short again_reg_val_1;
+      unsigned short again_reg_val_2;
+      unsigned short again_reg_val_3;
+      unsigned short again_reg_val_4;
+} Gain_ARRAY;
+
+const static I2C_ARRAY Sensor_init_table[] =
+{
+/****************************************/
+//version 6.3
+//mclk 27Mhz
+//mipiclk 648Mhz
+//framelength 1500
+//linelength 4800
+//pclk 216Mhz
+//rowtime 22.2222us
+//pattern grbg
+
+/****************************************/
+
+/****************************************/
+/*SYSTEM*/
+/****************************************/
+{0x03fe, 0xf0},
+{0x03fe, 0x00},
+{0x0317, 0x00},
+{0x0320, 0x77},
+{0x0324, 0xc8},
+{0x0325, 0x06},
+{0x0326, 0x60},
+{0x0327, 0x03},
+{0x0334, 0x40},
+{0x0336, 0x60},
+{0x0337, 0x82},
+{0x0315, 0x25},
+{0x031c, 0xc6},
+/****************************************/
+/*frame structure*/
+/****************************************/
+{0x0287, 0x18},
+{0x0084, 0x00},
+{0x0087, 0x50},
+{0x029d, 0x08},
+{0x0290, 0x00},
+//AHD 30 other need change
+{0x0340, 0x05},
+{0x0341, 0xdc},
+{0x0345, 0x06},
+{0x034b, 0xb0},
+{0x0352, 0x08},
+{0x0354, 0x08},
+/****************************************/
+/*ANALOG CIRCUIT*/
+/****************************************/
+{0x02d1, 0xb0},
+{0x023c, 0x05},
+{0x0223, 0xfb},
+{0x0232, 0xc4},
+{0x0279, 0x53},
+{0x02d3, 0x01},
+{0x0243, 0x06},
+{0x02ce, 0xbf},
+{0x02ee, 0x30},
+{0x026f, 0x70},
+{0x0257, 0x09},
+{0x0211, 0x02},
+{0x0219, 0x09},
+{0x023f, 0x2d},
+{0x0518, 0x00},
+{0x0519, 0x01},
+{0x0515, 0x08},
+{0x02d9, 0x3f},
+{0x02da, 0x02},
+{0x02db, 0xe8},
+{0x02e6, 0x20},
+{0x021b, 0x10},
+{0x0252, 0x22},
+{0x024e, 0x22},
+{0x02c4, 0x01},
+{0x021d, 0x07},
+{0x024a, 0x01},
+{0x02ca, 0x02},
+{0x0262, 0x10},
+{0x029a, 0x20},
+{0x021c, 0x0e},
+{0x0298, 0x03},
+{0x029c, 0x00},
+{0x027e, 0x14},
+{0x02c2, 0x10},
+{0x0540, 0x20},
+{0x0546, 0x01},
+{0x0548, 0x01},
+{0x0544, 0x01},
+{0x0242, 0x1b},
+{0x02c0, 0x1b},
+{0x02c3, 0x20},
+{0x02e4, 0x10},
+{0x022e, 0x00},
+{0x027b, 0x3f},
+{0x0269, 0x0f},
+{0x02d2, 0x40},
+{0x027c, 0x08},
+{0x023a, 0x2e},
+{0x0245, 0xce},
+{0x0530, 0x20},
+{0x0531, 0x02},
+{0x0228, 0x28},
+{0x02ab, 0x00},
+{0x0250, 0x00},
+{0x0221, 0x28},
+{0x02ac, 0x00},
+{0x02a5, 0x02},
+{0x0260, 0x0b},
+{0x0216, 0x04},
+{0x0299, 0x1C},
+{0x02bb, 0x0d},
+{0x02a3, 0x02},
+{0x02a4, 0x02},
+{0x021e, 0x02},
+{0x024f, 0x08},
+{0x028c, 0x08},
+{0x0532, 0x3f},
+{0x0533, 0x02},
+{0x0277, 0x38},
+{0x0276, 0x60},
+{0x0239, 0xc0},
+/*exp*/
+{0x0202, 0x05},
+{0x0203, 0xd0},
+/*gain*/
+{0x0205, 0xc0},
+{0x02b0, 0x60}, //0x90
+/*dpc*/
+{0x0002, 0xa9},
+{0x0004, 0x01},
+/****************************************/
+/*mipi*/
+/****************************************/
+//30fps
+{0x0342, 0x06},
+{0x0343, 0x40},
+{0x03fe, 0x10},
+{0x03fe, 0x00},
+{0x0106, 0x78},
+{0x0108, 0x0c},
+{0x0114, 0x01},
+{0x0115, 0x12},
+{0x0180, 0x46},
+{0x0181, 0x30},
+{0x0182, 0x05},
+{0x0185, 0x01},
+{0x03fe, 0x10},
+{0x03fe, 0x00},
+{0x0100, 0x09},
+};
+
+const I2C_ARRAY TriggerStartTbl[] = {
+//{0x30f4,0x00},//Master mode start
+};
+
+const I2C_ARRAY PatternTbl[] = {
+    //pattern mode
+};
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@                                                                                    //
+//                 @@                                                                                    //
+//             @@@                                                                                      //
+//       @       @@                                                                                    //
+//         @@@@                                                                                        //
+//                                                                                                          //
+//      Step 3 --  complete camera features                                              //
+//                                                                                                         //
+//                                                                                                         //
+//  camera set EV, MWB, orientation, contrast, sharpness                          //
+//   , saturation, and Denoise can work correctly.                                     //
+//                                                                                                          //
+/////////////////////////////////////////////////////////////////
+
+const I2C_ARRAY mirror_reg[] = {
+    {0x0101, 0x00},
+};
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+static int g_sensor_ae_min_gain = 1024;//1280;
+
+const static I2C_ARRAY gain_reg[] = {
+    {0x02b3, 0x00},
+    {0x0519, 0x04},
+    {0x02d9, 0x42},
+    {0x02b8, 0x01},
+    {0x02b9, 0x00},
+    {0x020e, 0x01},
+    {0x020f, 0x00},
+};
+
+const static I2C_ARRAY expo_reg[] = {
+    {0x0203, 0xd0}, // expo[7:0]
+    {0x0202, 0x05}, // expo[15:8]
+};
+
+const static I2C_ARRAY vts_reg[] = {
+    {0x0340, 0x05},
+    {0x0341, 0xdc},
+};
+
+ static Gain_ARRAY gain_table[]={
+           //02b3, 0519, 02d9, 02b8, 02b9
+     { 1024, 0x00, 0x04, 0x42, 0x01, 0x00},
+     { 1213, 0x20, 0x05, 0x43, 0x01, 0x0B},
+     { 1434, 0x01, 0x04, 0x42, 0x01, 0x19},
+     { 1699, 0x21, 0x05, 0x43, 0x01, 0x2a},
+     { 2048, 0x02, 0x04, 0x42, 0x02, 0x00},
+     { 2427, 0x22, 0x05, 0x43, 0x02, 0x17},
+     { 2867, 0x03, 0x05, 0x43, 0x02, 0x33},
+     { 3398, 0x23, 0x06, 0x44, 0x03, 0x14},
+     { 4096, 0x04, 0x06, 0x44, 0x04, 0x00},
+     { 4854, 0x24, 0x08, 0x46, 0x04, 0x2f},
+     { 5734, 0x05, 0x08, 0x46, 0x05, 0x26},
+     { 6795, 0x25, 0x0a, 0x48, 0x06, 0x28},
+     { 8192, 0x06, 0x0c, 0x4a, 0x08, 0x00},
+     { 9708, 0x26, 0x0d, 0x4b, 0x09, 0x1E},
+     {11469, 0x46, 0x0f, 0x4d, 0x0B, 0x0C},
+     {13591, 0x66, 0x11, 0x4f, 0x0D, 0x11},
+     {16384, 0x0e, 0x13, 0x51, 0x10, 0x00},
+     {19415, 0x2e, 0x16, 0x54, 0x12, 0x3D},
+     {22938, 0x4e, 0x19, 0x57, 0x16, 0x19},
+     {27181, 0x6e, 0x1b, 0x59, 0x1A, 0x22},
+     {32768, 0x1e, 0x1e, 0x5c, 0x20, 0x00},
+     {38830, 0x3e, 0x21, 0x5f, 0x25, 0x3A},
+     {45875, 0x5e, 0x25, 0x63, 0x2C, 0x33},
+     {54362, 0x7e, 0x29, 0x67, 0x35, 0x05},
+     {65536, 0x9e, 0x2d, 0x6b, 0x40, 0x00},
+     {77660, 0xbe, 0x40, 0x78, 0x4B, 0x35},
+};
+
+#if 0
+static CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////// function definition ///////////////////
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) SENSOR_DMSG(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+#define SENSOR_DMSG(args...) SENSOR_DMSG(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+#undef SENSOR_NAME
+#define SENSOR_NAME gc4653
+
+
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle);
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+
+//static u32 timeGetTimeU(void)
+//{
+//    CamOsTimespec_t tRes;
+//    CamOsGetMonotonicTime(&tRes);
+//    return (tRes.nSec * 1000000)+(tRes.nNanoSec/1000);
+//}
+//static u32 TStart = 0;
+
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    //TStart = timeGetTimeU();
+    /*PAD and CSI*/
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);   ///???
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);  ///???
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);    //=========   ????
+
+    /*Power ON*/
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    SENSOR_USLEEP(1000);
+
+    /*Reset PIN*/
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    SENSOR_USLEEP(1000);
+    SENSOR_DMSG("[%s] reset high\n", __FUNCTION__);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+
+    /*MCLK ON*/
+    sensor_if->MCLK(idx, 1, handle->mclk);
+     SENSOR_USLEEP(5000);
+    //CamOsPrintf("pCus_poweron = %d us \n",timeGetTimeU()-TStart);
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] power low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    //handle->i2c_bus->i2c_close(handle->i2c_bus);
+    SENSOR_USLEEP(1000);
+    //Set_csi_if(0, 0);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8) table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>2) return FAIL;
+
+      if( SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+          break;
+      else
+          continue;
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+      if( id_from_sensor[i].data != Sensor_id_table[i].data )
+        return FAIL;
+      //*id = id_from_sensor[i].data;
+      *id = ((*id)+ id_from_sensor[i].data)<<8;
+    }
+
+    *id >>= 8;
+    SENSOR_DMSG("[%s]gc4653 Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    //SENSOR_DMSG("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+
+    return SUCCESS;
+}
+
+static int gc4653_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+
+    SENSOR_DMSG("\n\n[%s], mode=%d \n", __FUNCTION__, mode);
+
+    return SUCCESS;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+//static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain);
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+static int pCus_init(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+    //TStart = timeGetTimeU();
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table);i++)
+    {
+        if(Sensor_init_table[i].reg==0xffff)
+        {
+            msleep(Sensor_init_table[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table[i].reg,Sensor_init_table[i].data) != SUCCESS)
+            {
+                cnt++;
+
+                if(cnt>=10)
+                {
+
+                    return FAIL;
+                }
+                msleep(10);
+            }
+        }
+    }
+/*
+    for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+    {
+        if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+        {
+            //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+            return FAIL;
+        }
+    }
+*/
+    pCus_SetAEGain(handle,1024); //Set sensor gain = 1x
+    pCus_SetAEUSecs(handle, 30000);
+    pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init;
+            break;
+
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit) {
+    char sen_data;
+    sen_data = mirror_reg[0].data;
+    SENSOR_DMSG("mirror:%x\r\n", sen_data);
+    switch(sen_data) {
+    case 0x03:
+        *orit = CUS_ORIT_M0F0;
+        break;
+    case 0x02:
+        *orit = CUS_ORIT_M1F0;
+        break;
+    case 0x01:
+        *orit = CUS_ORIT_M0F1;
+        break;
+    case 0x00:
+        *orit = CUS_ORIT_M1F1;
+        break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit) {
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+    switch(orit) {
+    case CUS_ORIT_M0F0:
+        params->tMirror_reg[0].data = 0x03;
+        params->orient_dirty = true;
+        //params->dirty = true;
+        break;
+    case CUS_ORIT_M1F0:
+        params->tMirror_reg[0].data = 0x2;
+        params->orient_dirty = true;
+        //params->dirty = true;
+        break;
+    case CUS_ORIT_M0F1:
+        params->tMirror_reg[0].data = 0x01;
+        params->orient_dirty = true;
+        //params->dirty = true;
+        break;
+    case CUS_ORIT_M1F1:
+        params->tMirror_reg[0].data = 0x00;
+        params->orient_dirty = true;
+        //params->dirty = true;
+        break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+    return  params->expo.fps;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    int vts=0;
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    if(fps>=5 && fps <= 30){
+      params->expo.fps = fps;
+      params->expo.vts=  (vts_30fps*30)/fps;
+    }else if(fps>=5000 && fps <= 30000){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*30000)/fps;
+    }else{
+      //params->expo.vts=vts_30fps;
+      //params->expo.fps=30;
+      //SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+      return FAIL;
+    }
+
+    if ((params->expo.line) > (params->expo.vts)-4) {
+        vts = params->expo.line + 4;
+    }else
+        vts = params->expo.vts;
+    params->tVts_reg[0].data = (vts >> 8) & 0x003f;
+    params->tVts_reg[1].data = (vts >> 0) & 0x00ff;
+    //vts_reg[0].data = ((params->expo.vts - 12 ) >> 8) & 0x001f;
+    //vts_reg[1].data = ((params->expo.vts - 12) >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap) {
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status){
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+
+            break;
+        case CUS_FRAME_ACTIVE:
+            if(params->orient_dirty)
+            {
+                SensorRegArrayW((I2C_ARRAY*)params->tMirror_reg, ARRAY_SIZE(mirror_reg));
+                params->orient_dirty = false;
+		    }
+            if(params->dirty)
+            {
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                params->dirty = false;
+            }
+            break;
+        default :
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us) {
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+    u32 lines = 0;
+
+    lines  = (u32)(params->tExpo_reg[0].data&0xff);
+    lines |= (u32)(params->tExpo_reg[1].data&0x3f)<<8;
+
+    *us = (lines*Preview_line_period)/1000;
+
+
+    SENSOR_DMSG("[%s] sensor expo lines/us %ld,%ld us\n", __FUNCTION__, lines, *us);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us) {
+    u32 lines = 0, vts = 0;
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+
+    lines=(1000*us)/Preview_line_period;
+
+    if(lines<1) lines=1;
+    if (lines > params->expo.vts-4) {
+        vts = lines + 4;
+    }else
+        vts = params->expo.vts;
+
+    params->expo.line = lines;
+    SENSOR_DMSG("[%s] us %ld, lines %ld, vts %ld\n", __FUNCTION__,
+                us,
+                lines,
+                params->expo.vts
+                );
+    params->tExpo_reg[0].data = (lines) & 0x00ff;
+    params->tExpo_reg[1].data = (lines>>8) & 0x003f;
+    params->tVts_reg[0].data = (vts >> 8) & 0x003f;
+    params->tVts_reg[1].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain) {
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+    u32 Again_0 = 1, Dgain_0 = 1;
+    u8 i;
+    u32  Fine_again = 1024;
+
+    for(i = 0;i < sizeof(gain_table)/sizeof(Gain_ARRAY);i++ )    {
+        if(( gain_table[i].again_reg_val_0 == params->tGain_reg[1].data) && (gain_table[i].again_reg_val_1 == params->tGain_reg[2].data))
+        {
+            Fine_again = gain_table[i].gain;
+            break;
+        }
+    }
+
+    Dgain_0 = (params->tGain_reg[5].data & 0xf) * 64 + (params->tGain_reg[6].data >> 2);
+    Again_0 = Fine_again;
+    *gain =(u32)((Again_0 * Dgain_0)/64);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain) {
+    gc4653_params *params = (gc4653_params *)handle->private_data;
+    u32 dgain = 1;
+//  u32 gain_64 = gain;
+    u8 dgain_0 = 1, dgain_1 = 0;
+    u8 i = 0,tmp = 0;
+//    int temperature_value;
+    params->expo.final_gain = gain;
+
+    if (gain < 1024) {
+        gain = 1024;
+    } else if (gain > SENSOR_MAX_GAIN  * 1024) {
+        gain = SENSOR_MAX_GAIN  * 1024;
+    }
+
+    for(i = 1;i < sizeof(gain_table)/sizeof(Gain_ARRAY);i++ )
+    {
+        if((gain >= gain_table[i-1].gain) && (gain < gain_table[i].gain))
+        {
+            tmp = i - 1;
+            break;
+        }
+        else
+            tmp = sizeof(gain_table)/sizeof(Gain_ARRAY) - 1;
+    }
+
+    dgain =(gain*64)/(gain_table[tmp].gain);
+    dgain_0 = (dgain)>>6;
+    dgain_1 =(dgain & 0x3f)<<2;
+    params->tGain_reg[0].data  = gain_table[tmp].again_reg_val_0;
+    params->tGain_reg[1].data  = gain_table[tmp].again_reg_val_1;
+    params->tGain_reg[2].data  = gain_table[tmp].again_reg_val_2;
+    params->tGain_reg[3].data  = gain_table[tmp].again_reg_val_3;
+    params->tGain_reg[4].data  = gain_table[tmp].again_reg_val_4;
+
+    params->tGain_reg[5].data  = dgain_0;
+    params->tGain_reg[6].data  = dgain_1;
+    SENSOR_DMSG("[%s] set gain/regH/regL=%d/0x%x/0x%x\n", __FUNCTION__, gain,gain_reg[1].data,gain_reg[2].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min = 30;
+    *max = 1000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min =handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN*1024;
+    return SUCCESS;
+}
+
+static int gc4653_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min =  Preview_line_period*1;//2
+    info->step = Preview_line_period*1;//2
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle(ms_cus_sensor* drv_handle) {
+   ms_cus_sensor *handle = drv_handle;
+    gc4653_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (gc4653_params *)handle->private_data;
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tMirror_reg, mirror_reg, sizeof(mirror_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    strcpy(handle->model_id,"gc4653_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0;
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= 0;
+    handle->video_res_supported.res[0].crop_start_y= 0;
+    handle->video_res_supported.res[0].nOutputWidth= 2560;
+    handle->video_res_supported.res[0].nOutputHeight= 1440;
+    SENSOR_DMSG(handle->video_res_supported.res[0].strResDesc, "2560x1440@30fps");
+
+    // i2c
+
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 2;
+    handle->ae_shutter_delay    = 2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 1;
+
+    ///calibration
+    handle->sat_mingain=g_sensor_ae_min_gain;
+
+
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init    ;
+
+    handle->pCus_sensor_poweron     = pCus_poweron ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = gc4653_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+     //sensor calibration
+//    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = gc4653_GetShutterInfo;
+    params->expo.vts=vts_30fps;
+    params->expo.fps = 30;
+    params->expo.line = 100;
+    params->dirty = false;
+    params->orient_dirty = false;
+    return SUCCESS;
+}
+
+int cus_camsensor_release_handle(ms_cus_sensor *handle) {
+
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(  gc4653,
+                            cus_camsensor_init_handle,
+                            NULL,
+                            NULL,
+                            gc4653_params
+                         );
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_imx307_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_imx307_mipi.c
new file mode 100644
index 00000000..adeb0367
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_imx307_mipi.c
@@ -0,0 +1,3208 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(IMX307_HDR);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+#define SENSOR_CHANNEL_imx307_ISP_CALIBRATION_ENABLE (1)
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (2)
+#define SENSOR_MIPI_LANE_NUM_DOL (4)
+//#define SENSOR_MIPI_HDR_MODE (0) //0: Non-HDR mode. 1:Sony DOL mode
+//MIPI config end.
+#define HDR_DOL_10bit (0)
+#define HDR_DOL_12bit (1)
+//============================================
+
+//#define LOGD //(...)
+
+//c11 extern int usleep(u32 usec);
+//int usleep(u32 usec);
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+#undef SENSOR_DBG
+#define SENSOR_DBG 0
+
+///////////////////////////////////////////////////////////////
+//          @@@                                                                                       //
+//       @   @@      ==  S t a r t * H e r e ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                           //
+//         @@@@                                                                                  //
+//                                                                                                     //
+//      Start Step 1 --  show preview on LCM                                         //
+//                                                                                                    ���?//
+//  Fill these #define value and table with correct settings                        //
+//      camera can work and show preview on LCM                                 //
+//                                                                                                       //
+///////////////////////////////////////////////////////////////
+#define SENSOR_ISP_TYPE     ISP_EXT                   //ISP_EXT, ISP_SOC
+//#define F_number  22                                  // CFG, demo module
+//#define SENSOR_DATAFMT      CUS_DATAFMT_BAYER        //CUS_DATAFMT_YUV, CUS_DATAFMT_BAYER
+#define SENSOR_IFBUS_TYPE   CUS_SENIF_BUS_MIPI      //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE PACKET_HEADER_EDGE1
+#define SENSOR_MIPI_HSYNC_MODE_HDR_DOL PACKET_FOOTER_EDGE
+#define SENSOR_DATAPREC     CUS_DATAPRECISION_12    //CFG //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#if HDR_DOL_10bit
+#define SENSOR_DATAPREC_DOL     CUS_DATAPRECISION_10
+#endif
+#if HDR_DOL_12bit
+#define SENSOR_DATAPREC_DOL     CUS_DATAPRECISION_12
+#endif
+#define SENSOR_DATAMODE     CUS_SEN_10TO12_9098     //CFG
+#define SENSOR_BAYERID      CUS_BAYER_RG //CUS_BAYER_GR            //CFG //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_BAYERID_HDR_DOL      CUS_BAYER_RG//CUS_BAYER_GR
+#define SENSOR_RGBIRID      CUS_RGBIR_NONE
+#ifndef SENSOR_ORIT
+#define SENSOR_ORIT         CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+#endif
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+//#define lane_number 2
+//#define vc0_hs_mode 3   //0: packet header edge  1: line end edge 2: line start edge 3: packet footer edge
+//#define long_packet_type_enable 0x00 //UD1~UD8 (user define)
+#define SENSOR_MAX_GAIN     (2818 * 1024)                  // max sensor again, a-gain * conversion-gain*d-gain
+#define SENSOR_MIN_GAIN      (1 * 1024)
+
+#define SENSOR_GAIN_DELAY_FRAME_COUNT      (1)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT      (2)
+
+#define SENSOR_GAIN_DELAY_FRAME_COUNT_DOL      (2)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT_DOL    (2)
+
+#define Preview_MCLK_SPEED  CUS_CMU_CLK_37P125MHZ //CUS_CMU_SCL_CLK_37P125M        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+//#define Preview_line_period 30000                  ////HTS/PCLK=4455 pixels/148.5MHZ=30usec @MCLK=36MHz
+//#define vts_30fps 1125//1346,1616                 //for 29.1fps @ MCLK=36MHz
+//For MCLK = 36Mhz
+//#define Preview_line_period 30556//30580                  //(36M/37.125M)*30fps=29.091fps(34.375msec), hts=34.375/1125=30556,
+//For MCLK = 37.125Mhz
+#define Preview_line_period 29629                           // hts=33.333/1125=25629,
+#if HDR_DOL_10bit
+//For MCLK = 36Mhz
+//#define Preview_line_period_HDR_DOL_4LANE 28176//14842//30535//30580   10^9 / (1158 * 2) / 29.091   //(36M/37.125M)*30.02fps=29.11fps(34.352msec), hts=34.375/1220=28176,
+//For MCLK = 37.125Mhz
+#define Preview_line_period_HDR_DOL_4LANE 27322         //hts=33.333/1220=27322
+#endif
+#if HDR_DOL_12bit
+//For MCLK = 36Mhz
+//#define Preview_line_period_HDR_DOL_4LANE (29684 / 2) //29684//14842//30535//30580   10^9 / (1158 * 2) / 29.091   //(36M/37.125M)*30.02fps=29.11fps(34.352msec), hts=34.352/1158=30556,
+//For MCLK = 37.125Mhz
+#define Preview_line_period_HDR_DOL_4LANE (28784 / 2)   //33.333/1158=28784,
+//For MCLK = 36Mhz
+//#define Preview_line_period_HDR_DOL_2LANE (29684/*30501*/ / 2)
+//For MCLK = 37.125Mhz
+#define Preview_line_period_HDR_DOL_2LANE (28784/*30501*/ / 2)
+#endif
+//#define Line_per_second     32727
+#define vts_30fps  1125//1090                              //for 29.091fps @ MCLK=36MHz
+#if HDR_DOL_10bit
+#define vts_30fps_HDR_DOL_4lane  1220//1125//1090                              //for 29.091fps @ MCLK=36MHz //VMAX
+#endif
+#if HDR_DOL_12bit
+#define vts_30fps_HDR_DOL_4lane  1158//1125//1090                              //for 29.091fps @ MCLK=36MHz //VMAX
+#define vts_30fps_HDR_DOL_2lane  1158
+#endif
+#define MAX_DOL_RHS1 ((1158 * 2) - (1097/*BRL HD1080p*/ * 2) - 21) //must 1158
+#define Prv_Max_line_number 1080                    //maximum exposure line munber of sensor when preview
+#define Preview_WIDTH       1920                    //resolution Width when preview
+#define Preview_HEIGHT      1080                    //resolution Height when preview
+#define Preview_HEIGHT_HDR_DOL      1080                    //resolution Height when preview
+#define Preview_MAX_FPS     30                     //fastest preview FPS
+#define Preview_MIN_FPS     3                      //slowest preview FPS
+#define Preview_CROP_START_X     0                      //CROP_START_X
+#define Preview_CROP_START_Y     0                      //CROP_START_Y
+
+#define SENSOR_I2C_ADDR    0x34                   //I2C slave address
+#define SENSOR_I2C_SPEED   20000//200000 //300000// 240000                  //I2C speed, 60000~320000
+#define SENSOR_I2C_CHANNEL 	1							//I2C Channel
+#define SENSOR_I2C_PAD_MODE 2							//Pad/Mode Number
+
+#define SENSOR_I2C_LEGACY  I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT     I2C_FMT_A16D8        //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL     CUS_CLK_POL_NEG        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL      CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+
+#define SENSOR_VSYNC_POL    CUS_CLK_POL_NEG        // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL    CUS_CLK_POL_NEG        // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL     CUS_CLK_POL_NEG        // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+//static int  drv_Fnumber = 22;
+
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+//#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+#undef SENSOR_NAME
+#define SENSOR_NAME IMX307
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+
+//#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+//#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+//#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+//#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle);
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+static CUS_MCLK_FREQ UseParaMclk(const char *mclk);
+static int pCus_SetAEUSecsHDR_DOL_SEF1(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us);
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 expo_lines;
+        u32 expo_lef_us;
+        u32 expo_sef_us;
+    } expo;
+
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    u32 max_rhs1;
+    u32 lef_shs2;
+    u32 skip_cnt;
+    bool dirty;
+    bool change;
+    I2C_ARRAY tVts_reg[3];
+    I2C_ARRAY tGain_reg[3];
+    I2C_ARRAY tExpo_reg[3];
+    I2C_ARRAY tShs2_reg[3];
+    I2C_ARRAY tRhs1_reg[3];
+    I2C_ARRAY tGain_hdr_dol_lef_reg[1];
+    I2C_ARRAY tGain_hdr_dol_sef_reg[1];
+    bool orien_dirty;
+} imx307_params;
+// set sensor ID address and data,
+
+const static I2C_ARRAY Sensor_id_table[] =
+{
+    {0x3004, 0x10},      // {address of ID, ID },
+    {0x3009, 0x01},      // {address of ID, ID },
+};
+
+const static I2C_ARRAY Sensor_init_table_4lane[] =
+{
+    {0x3002, 0x01},   //Master mode stop
+    {0xffff, 0x14},//delay
+    {0x3000, 0x01},   // standby
+    {0xffff, 0x14},//delay
+    {0x3005, 0x01},
+    {0x3007, 0x00},//mirror/flip
+    {0x3009, 0x02},//FRSEL
+  //  {0x300A, 0xF0},
+  //  {0x300F, 0x00},
+  //  {0x3010, 0x21},
+    {0x3011, 0x0A},
+    {0x3012, 0x64},
+    {0x3013, 0x00},
+    //{0x3016, 0x08},//yc modify
+    {0x3018, 0x65},//VMAX
+    {0x3019, 0x04},
+    {0x301a, 0x00},
+    {0x301c, 0x30},//0x1167 HMAX,for 25fps
+    {0x301d, 0x11},
+
+    {0x3046, 0x01},
+    //{0x304B, 0x0a},//arbitary value
+    {0x305C, 0x18},//INCK
+    {0x305D, 0x03},
+    {0x305E, 0x20},
+    {0x305F, 0x01},
+
+    //{0x3070, 0x02},
+   // {0x3071, 0x11},
+   // {0x309B, 0x10},
+   // {0x309C, 0x22},
+    {0x309E, 0x4A},
+    {0x309F, 0x4A},
+ //   {0x30A0, 0x02},//new add
+ //   {0x30A2, 0x02},
+ //   {0x30A6, 0x20},
+ //   {0x30A8, 0x20},
+  //  {0x30AA, 0x20},
+ //   {0x30AC, 0x20},
+  //  {0x30B0, 0x43},
+
+   // {0x3119, 0x9E},
+    {0x311C, 0x0E},
+  //  {0x311E, 0x08},
+    {0x3128, 0x04},
+    {0x3129, 0x00},
+    {0x313B, 0x41},
+ //   {0x313D, 0x83},
+   // {0x3150, 0x02},
+    {0x315E, 0x1A},//INCKSEL5
+    {0x3164, 0x1A},//INCKSEL6
+    {0x317C, 0x00},//ADBIT2
+    {0x317E, 0x00},
+    {0x31EC, 0x0E},
+
+
+    {0x3405, 0x20},
+    {0x3407, 0x03},  // 4 lane for phy
+  //  {0x3414, 0x0A},
+    {0x3418, 0x49},//Y-out
+    {0x3419, 0x04},
+  //  {0x342C, 0x47},
+  //  {0x342D, 0x00},
+   // {0x3430, 0x0F},
+  //  {0x3431, 0x00},
+    {0x3441, 0x0C},
+    {0x3442, 0x0C},
+    {0x3443, 0x03},  // 4 lane
+    {0x3444, 0x20},
+    {0x3445, 0x25},
+    {0x3446, 0x47},
+    {0x3447, 0x00},
+    {0x3448, 0x1F},
+    {0x3449, 0x00},
+    {0x344A, 0x17},
+    {0x344B, 0x00},
+    {0x344C, 0x0F},
+    {0x344D, 0x00},
+    {0x344E, 0x17},
+    {0x344F, 0x00},
+    {0x3450, 0x47},
+    {0x3451, 0x00},
+    {0x3452, 0x0F},
+    {0x3453, 0x00},
+    {0x3454, 0x0F},
+    {0x3455, 0x00},
+    {0x3472, 0x9c},//x-out size
+    {0x3473, 0x07},
+    {0x3480, 0x49},//0x9c
+
+    {0x3000, 0x00},   // operating
+    //{0xffff, 0x14},
+
+    {0x3002, 0x00},   //Master mode start
+};
+
+const static I2C_ARRAY Sensor_init_table_2lane[] =
+{
+
+    {0x3002, 0x00},   //Master mode stop
+    {0xffff, 0x14},//delay
+    {0x3000, 0x01},   // standby
+    {0xffff, 0x14},//delay
+    {0x3005, 0x01},
+   // {0x3007, 0x00},//mirror/flip
+    {0x3009, 0x02},//FRSEL
+  //  {0x300A, 0xF0},
+  //  {0x300F, 0x00},
+  //  {0x3010, 0x21},
+    {0x3011, 0x0A},
+  //  {0x3012, 0x64},
+  //  {0x3013, 0x00},
+    {0x3016, 0x08},//yc modify
+    {0x3018, 0x65},//VMAX
+    {0x3019, 0x04},
+    {0x301c, 0x30},//0x1167 HMAX,for 25fps
+    {0x301d, 0x11},
+
+    //{0x3046, 0x01},
+    //{0x304B, 0x0a},//arbitary value
+    {0x305C, 0x18},//INCK
+    {0x305D, 0x03},
+    {0x305E, 0x20},
+    //{0x305F, 0x01},
+
+    //{0x3070, 0x02},
+   // {0x3071, 0x11},
+   // {0x309B, 0x10},
+   // {0x309C, 0x22},
+    {0x309E, 0x4A},
+    {0x309F, 0x4A},
+ //   {0x30A0, 0x02},//new add
+ //   {0x30A2, 0x02},
+ //   {0x30A6, 0x20},
+ //   {0x30A8, 0x20},
+  //  {0x30AA, 0x20},
+ //   {0x30AC, 0x20},
+  //  {0x30B0, 0x43},
+
+   // {0x3119, 0x9E},
+    {0x311C, 0x0E},
+  //  {0x311E, 0x08},
+    {0x3128, 0x04},
+    {0x3129, 0x00},
+    {0x313B, 0x41},
+ //   {0x313D, 0x83},
+   // {0x3150, 0x02},
+    {0x315E, 0x1A},//INCKSEL5
+    {0x3164, 0x1A},//INCKSEL6
+    {0x317C, 0x00},//ADBIT2
+    {0x317E, 0x00},
+    {0x31EC, 0x0E},
+
+
+    {0x3405, 0x10},
+    {0x3407, 0x01},  // 2 lane for phy
+  //  {0x3414, 0x0A},
+    {0x3418, 0x49},//Y-out
+    {0x3419, 0x04},
+  //  {0x342C, 0x47},
+  //  {0x342D, 0x00},
+   // {0x3430, 0x0F},
+  //  {0x3431, 0x00},
+  //  {0x3441, 0x0C},
+  //  {0x3442, 0x0C},
+    {0x3443, 0x01},  // 2 lane
+    {0x3444, 0x20},
+    {0x3445, 0x25},
+    {0x3446, 0x57},
+  //  {0x3447, 0x00},
+    {0x3448, 0x37},
+   // {0x3449, 0x00},
+    {0x344A, 0x1F},
+   // {0x344B, 0x00},
+    {0x344C, 0x1F},
+  //  {0x344D, 0x00},
+    {0x344E, 0x1f},
+   // {0x344F, 0x00},
+    {0x3450, 0x77},
+  //  {0x3451, 0x00},
+    {0x3452, 0x1F},
+  //  {0x3453, 0x00},
+    {0x3454, 0x17},
+   // {0x3472, 0x9c},//x-out size
+   // {0x3473, 0x07},
+    {0x3480, 0x49},//0x9c
+
+    {0x3000, 0x00},   // operating
+    {0xffff, 0x14},
+
+
+   // {0x3002, 0x00},   //Master mode start
+};
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_4lane[] =
+{
+#if HDR_DOL_10bit
+    //DOL 2frame 1080p 10bit
+    {0x3002, 0x01},
+    {0xffff, 0x14},
+    {0x3000, 0x01},
+    {0xffff, 0x14},
+
+    {0x3005, 0x00},
+    //{0x3007, 0x00},   //WINMODE
+    {0x3007, 0x40},
+
+    {0x3009, 0x01},
+    {0x300A, 0x3C},
+    {0x300C, 0x11},
+    {0x3011, 0x0A},
+
+
+    //{0x3018, 0x65}, //VMAX
+    //{0x3019, 0x04},
+    {0x3018, 0xC4},
+    {0x3019, 0x04},
+
+    //{0x301c, 0x98}, //HMAX
+    //{0x301d, 0x08},
+    {0x301c, 0xEC},
+    {0x301d, 0x07},
+
+    {0x3020, 0x02}, // SHS1
+    {0x3021, 0x00}, // SHS1
+    {0x3022, 0x00}, // SHS1
+
+    {0x3024, 0x53}, // SHS2
+    {0x3025, 0x04}, // SHS2
+    {0x3026, 0x00}, // SHS2
+
+    {0x3028, 0x00}, // SHS3
+    {0x3029, 0x00}, // SHS3
+    {0x302A, 0x00}, // SHS3
+
+    {0x3030, 0xe1},//RHS1
+    {0x3031, 0x00},
+    {0x3032, 0x00},
+
+    {0x3034, 0x00},//RHS2
+    {0x3035, 0x00},
+    {0x3036, 0x00},
+
+    {0x303A, 0x08}, // WIN
+    {0x303C, 0x04}, // WIN
+    {0x303E, 0x41}, // WIN
+    {0x303F, 0x04}, // WIN
+
+    {0x3045, 0x05},
+    {0x3046, 0x00},
+    {0x304B, 0x0A},
+    {0x305C, 0x18},
+    {0x305D, 0x03},
+    {0x305E, 0x20},
+    {0x305F, 0x01},
+    {0x309E, 0x4A},
+    {0x309F, 0x4A},
+
+    {0x3106, 0x11},
+    {0x311C, 0x0E},
+    {0x3128, 0x04},
+    {0x3129, 0x1D},
+    {0x313B, 0x41},
+    {0x315E, 0x1A},
+    {0x3164, 0x1A},
+    {0x317C, 0x12},
+    {0x31EC, 0x37},
+
+
+    {0x3405, 0x10},
+    {0x3407, 0x03},
+
+    //{0x3414, 0x0A}, //opb_size_v
+    {0x3414, 0x00},
+
+    {0x3415, 0x00},
+
+    //{0x3418, 0x9C},   //y_out_size
+    //{0x3419, 0x08},
+    {0x3418, 0x7A},
+    {0x3419, 0x09},
+
+
+    {0x3441, 0x0A},
+    {0x3442, 0x0A},
+    {0x3443, 0x03},
+    {0x3444, 0x20},
+    {0x3445, 0x25},
+    {0x3446, 0x57},
+    {0x3447, 0x00},
+    {0x3448, 0x37},
+    {0x3449, 0x00},
+    {0x344A, 0x1F},
+    {0x344B, 0x00},
+    {0x344C, 0x1F},
+    {0x344D, 0x00},
+    {0x344E, 0x1F},
+    {0x344F, 0x00},
+    {0x3450, 0x77},
+    {0x3451, 0x00},
+    {0x3452, 0x1F},
+    {0x3453, 0x00},
+    {0x3454, 0x17},
+    {0x3455, 0x00},
+    {0x3472, 0xA0},
+    {0x3473, 0x07},
+    {0x347B, 0x23},
+    {0x3480, 0x49},
+
+    {0x3000, 0x00},   // operating
+    //{0xffff, 0x14},
+
+    {0x3002, 0x00},   //Master mode start
+#endif
+
+#if HDR_DOL_12bit
+    //DOL 2frame 1080p 12bit
+    {0x3002, 0x01},
+    {0xffff, 0x14},
+    {0x3000, 0x01},
+    {0xffff, 0x14},
+
+    {0x3005, 0x01},
+    //{0x3007, 0x00},   //WINMODE
+    {0x3007, 0x40},
+
+    {0x3009, 0x01},
+    {0x300A, 0xF0},
+    {0x300C, 0x11},
+    {0x3011, 0x0A},
+
+
+    //{0x3018, 0x65}, //VMAX
+    //{0x3019, 0x04},
+    {0x3018, 0x86},
+    {0x3019, 0x04},
+
+    //{0x301c, 0x98}, //HMAX
+    //{0x301d, 0x08},
+    {0x301c, 0x58},
+    {0x301d, 0x08},
+
+    {0x3020, 0x02}, // SHS1
+    {0x3021, 0x00}, // SHS1
+    {0x3022, 0x00}, // SHS1
+
+    {0x3024, 0x73}, // SHS2
+    {0x3025, 0x04}, // SHS2
+    {0x3026, 0x00}, // SHS2
+
+    {0x3028, 0x00}, // SHS3
+    {0x3029, 0x00}, // SHS3
+    {0x302A, 0x00}, // SHS3
+
+    {0x3030, 0x65},//RHS1
+    {0x3031, 0x00},
+    {0x3032, 0x00},
+
+    {0x3034, 0x00},//RHS2
+    {0x3035, 0x00},
+    {0x3036, 0x00},
+
+    {0x303A, 0x08}, // WIN
+    {0x303C, 0x04}, // WIN
+    {0x303E, 0x41}, // WIN
+    {0x303F, 0x04}, // WIN
+
+    {0x3045, 0x05},
+    {0x3046, 0x01},
+    {0x304B, 0x0A},
+    {0x305C, 0x18},
+    {0x305D, 0x03},
+    {0x305E, 0x20},
+    {0x305F, 0x01},
+    {0x309E, 0x4A},
+    {0x309F, 0x4A},
+
+    {0x3106, 0x11},
+    {0x311C, 0x0E},
+    {0x3128, 0x04},
+    {0x3129, 0x00},
+    {0x313B, 0x41},
+    {0x315E, 0x1A},
+    {0x3164, 0x1A},
+    {0x317C, 0x00},
+    {0x31EC, 0x0E},
+
+    {0x3204, 0x4A},
+    {0x320A, 0x22},
+
+    {0x3344, 0x38},
+
+    {0x3405, 0x10},
+    {0x3407, 0x03},
+
+    //{0x3414, 0x0A}, //opb_size_v
+    {0x3414, 0x00},
+
+    {0x3415, 0x00},
+
+    //{0x3418, 0x9C},   //y_out_size
+    //{0x3419, 0x08},
+    {0x3418, 0x7A},
+    {0x3419, 0x09},
+
+    {0x3441, 0x0C},
+    {0x3442, 0x0C},
+    {0x3443, 0x03},
+    {0x3444, 0x20},
+    {0x3445, 0x25},
+    {0x3446, 0x57},
+    {0x3447, 0x00},
+    {0x3448, 0x37},
+    {0x3449, 0x00},
+    {0x344A, 0x1F},
+    {0x344B, 0x00},
+    {0x344C, 0x1F},
+    {0x344D, 0x00},
+    {0x344E, 0x1F},
+    {0x344F, 0x00},
+    {0x3450, 0x77},
+    {0x3451, 0x00},
+    {0x3452, 0x1F},
+    {0x3453, 0x00},
+    {0x3454, 0x17},
+    {0x3455, 0x00},
+    {0x3472, 0xA0},
+    {0x3473, 0x07},
+    {0x347B, 0x23},
+    {0x3480, 0x49},
+
+    {0x3000, 0x00},   // operating
+    //{0xffff, 0x14},
+
+    {0x3002, 0x00},   //Master mode start
+#endif
+};
+
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_2lane[] =
+{
+    {0x3002,0x01},
+    {0xffff, 0x14}, //test
+    {0x3000, 0x01}, //test
+    {0xffff, 0x14}, //test
+    {0x3005,0x01},
+
+    {0x3007,0x00},
+
+    {0x3009,0x01},
+    {0x300A,0xF0},
+    {0x300C,0x11},
+    {0x3011,0x0A},
+
+
+    {0x3018,0x86},
+
+    {0x3019,0x04},
+    {0x301C,0x58},
+    {0x301D,0x08},
+    {0x3020,0x02}, // SHS1
+    {0x3021,0x00}, // SHS1
+
+    {0x3024,0xC9}, // SHS2
+    {0x3025,0x06}, // SHS2
+    //{0x3026,0x06}, // SHS2
+    {0x3030,0x0B},
+    {0x3031,0x00},
+    //{0x3032,0x00},
+    {0x3045,0x05},
+    {0x3046,0x01},
+    //{0x3048,0x00},
+    //{0x3049,0x00},
+    {0x304B,0x0A},
+    {0x305C,0x18},
+    {0x305D,0x03},
+    {0x305E,0x20},
+    {0x305F,0x01},
+    {0x309E,0x4A},
+    {0x309F,0x4A},
+    {0x3106,0x11},
+    {0x311C,0x0E},
+    {0x311D,0x08},
+
+
+    {0x3128,0x04},
+    {0x3129,0x00},
+
+
+    {0x313B,0x41},
+    {0x315E,0x1A},
+    {0x3164,0x1A},
+    {0x317C,0x00},
+    {0x31EC,0x0E},
+    {0x3405,0x00},
+    {0x3407,0x01},
+    {0x3414,0x0A},
+    {0x3415,0x00},
+    //{0x3418,0x9C},
+    //{0x3419,0x08},
+    {0x3418,0x7A},
+    {0x3419,0x09},
+    {0x3441,0x0C},
+    {0x3442,0x0C},
+    {0x3443,0x01},
+    {0x3444,0x20},
+
+    {0x3445,0x25},
+
+    {0x3446,0x77},
+    {0x3447,0x00},
+    {0x3448,0x67},
+    {0x3449,0x00},
+    {0x344A,0x47},
+
+    {0x344B,0x00},
+    {0x344C,0x37},
+    {0x344D,0x00},
+    {0x344E,0x3F},
+    {0x344F,0x00},
+    {0x3450,0xFF},
+    {0x3451,0x00},
+    {0x3452,0x3F},
+    {0x3453,0x00},
+    {0x3454,0x37},
+    {0x3455,0x00},
+
+
+
+
+
+    {0x3472,0xA0},
+    {0x3473,0x07},
+    {0x347B,0x23},
+
+    {0x3480,0x49},
+
+    {0x3000, 0x00}, //test
+
+    {0x3002,0x00},
+
+};
+
+const static I2C_ARRAY TriggerStartTbl[] = {
+    {0x3002,0x00},//Master mode start
+};
+
+static I2C_ARRAY PatternTbl[] = {
+    {0x308c,0x20}, //colorbar pattern , bit 0 to enable
+};
+
+const static I2C_ARRAY gain_HDR_DOL_LEF_reg[] =
+{
+    {0x3014, 0x00},
+};
+
+const static I2C_ARRAY gain_HDR_DOL_SEF1_reg[] =
+{
+    {0x30F2, 0x00},
+};
+
+const static I2C_ARRAY expo_SHS2_reg[] =
+{
+#if 1 //decreasing exposure ratio version.
+    {0x3026, 0x00},
+    {0x3025, 0x08},
+    {0x3024, 0x49},
+#else
+    {0x3026, 0x00},
+    {0x3025, 0x07},
+    {0x3024, 0xc9},
+#endif
+};
+
+const I2C_ARRAY expo_RHS1_reg[] =
+{
+#if 1 //decreasing exposure ratio version.
+    {0x3032, 0x00},
+    {0x3031, 0x00},
+    {0x3030, 0x65}, /*101*/
+#else
+    {0x3032, 0x00},
+    {0x3031, 0x00},
+    {0x3030, 0x0b},
+#endif
+};
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@                                                                                    //
+//                 @@                                                                                    //
+//             @@@                                                                                      //
+//       @       @@                                                                                    //
+//         @@@@                                                                                        //
+//                                                                                                          //
+//      Step 3 --  complete camera features                                              //
+//                                                                                                         //
+//                                                                                                         //
+//  camera set EV, MWB, orientation, contrast, sharpness                          //
+//   , saturation, and Denoise can work correctly.                                     //
+//                                                                                                          //
+/////////////////////////////////////////////////////////////////
+
+
+const static I2C_ARRAY mirr_flip_table[] =
+{
+    {0x3007, 0x00},//M0F0
+    {0x3007, 0x02},//M1F0
+    {0x3007, 0x01},//M0F1
+    {0x3007, 0x03},//M1F1
+
+};
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+
+
+const static I2C_ARRAY gain_reg[] = {
+        //{0x350A, 0x00},//bit0, high bit
+        {0x3014, 0x00},//low bit
+        {0x3009, 0x02},//hcg mode,bit 4
+        {0x3016, 0x08},//
+
+};
+#if 0
+static I2C_ARRAY frame_drop_reg[] = {
+        //{0x350A, 0x00},//bit0, high bit
+        {0x4202, 0x01}, //frame mask
+        {0x3000, 0x23}, //timing reset
+        {0x3000, 0xa0}, //low bit
+
+};
+#endif
+//static int g_sensor_ae_min_gain = 1024;
+static CUS_GAIN_GAP_ARRAY gain_gap_compensate[16] = {  //compensate  gain gap
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0}
+};
+
+const static I2C_ARRAY expo_reg[] = {
+
+        {0x3022, 0x00},
+        {0x3021, 0x00},
+        {0x3020, 0x00},
+};
+
+const static I2C_ARRAY vts_reg[] = {
+        {0x301a, 0x00},
+        {0x3019, 0x04},
+        {0x3018, 0xC4},
+
+};
+
+#if 0
+static CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////// function definition ///////////////////
+
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+#if 0
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+#endif
+    return SUCCESS;
+}
+#endif
+
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    //Sensor power on sequence
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 1);
+    }
+
+    sensor_if->Reset(idx, handle->reset_POLARITY );
+    sensor_if->MCLK(idx, 1, handle->mclk);
+    SENSOR_UDELAY(20); //TLOW
+
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    SENSOR_UDELAY(20);
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    SENSOR_UDELAY(20);
+
+    sensor_if->Reset(idx, !handle->reset_POLARITY );
+    SENSOR_UDELAY(20); //TXCE
+
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+	ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 0);
+    }
+    handle->orient = SENSOR_ORIT;
+#if 0
+#if (SENSOR_MIPI_LANE_NUM == 2)
+	sensor_if->SetCSI_Lane(SENSOR_PAD_GROUP_SET, 2, 0);
+#endif
+#if (SENSOR_MIPI_LANE_NUM == 4)
+	sensor_if->SetCSI_Lane(SENSOR_PAD_GROUP_SET, 4, 0);
+#endif
+#endif
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+static int pCus_CheckSonyProductID(ms_cus_sensor *handle)
+{
+    u16 sen_data;
+
+    /* Read Product ID */
+    if (SensorReg_Read(0x31DC, (void*)&sen_data)) {
+        return FAIL;
+    }
+
+    if ((sen_data & 0x0006) != 0x4) {
+        SENSOR_EMSG("[***ERROR***]Check Product ID Fail: 0x%x\n", sen_data);
+        return FAIL;
+    }
+
+    return SUCCESS;
+}
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8) table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>2) return FAIL;
+
+      if(/* SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == */SUCCESS) //read sensor ID from I2C
+		  break;
+      else
+		  SENSOR_MSLEEP(1);
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+      if( id_from_sensor[i].data != Sensor_id_table[i].data )
+        return FAIL;
+      *id = id_from_sensor[i].data;
+    }
+
+
+    SENSOR_DMSG("[%s]IMX307 sensor ,Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    return SUCCESS;
+}
+
+static int imx307_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+    int i;
+  switch(mode)
+  {
+  case 1:
+    PatternTbl[0].data = 0x21; //enable
+  break;
+  case 0:
+    PatternTbl[0].data &= 0xFE; //disable
+  break;
+  default:
+    PatternTbl[0].data &= 0xFE; //disable
+  break;
+  }
+
+  for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+  {
+    if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+    {
+      //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+      return FAIL;
+    }
+  }
+
+  return SUCCESS;
+}
+
+#if 0//defined(__MV5_FPGA__)
+static int pCus_I2CWrite(ms_cus_sensor *handle, unsigned short usreg, unsigned short usval)
+{
+    //unsigned short sen_data;
+
+    SensorReg_Write(usreg, usval);
+    //SensorReg_Read(usreg, &sen_data);
+    //UartSendTrace("imx307_MIPI reg: 0x%x, data: 0x%x, read: 0x%x.\n", usreg, usval, sen_data);
+
+    return SUCCESS;
+}
+
+static int pCus_I2CRead(ms_cus_sensor *handle, unsigned short usreg, unsigned short* pusval)
+{
+    unsigned short usread_data;
+
+    SensorReg_Read(usreg, &usread_data);
+    *pusval = usread_data;
+    UartSendTrace("imx307_MIPI reg: 0x%x, data: 0x%x\n", usreg, usread_data);
+
+    return SUCCESS;
+}
+#endif
+#if 1//(SENSOR_MIPI_LANE_NUM == 4)
+static int pCus_init_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    int i,cnt=0;
+
+    if (pCus_CheckSonyProductID(handle)) {
+        return FAIL;
+    }
+
+    //UartSendTrace("IMX307 Sensor_init_table_4lane\n");
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane);i++)
+    {
+        if(Sensor_init_table_4lane[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane[i].reg,Sensor_init_table_4lane[i].data) != SUCCESS)
+            {
+                cnt++;
+                //printf("Sensor_init_table_4lane -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //SensorReg_Read( Sensor_init_table_4lane[i].reg, &sen_data );
+            //UartSendTrace("IMX307 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane[i].reg, Sensor_init_table_4lane[i].data, sen_data);
+        }
+    }
+
+    params->tVts_reg[0].data = (params->expo.vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (params->expo.vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (params->expo.vts >> 0) & 0x00ff;
+    pCus_SetOrien(handle, handle->orient);
+    return SUCCESS;
+}
+#endif
+#if (SENSOR_MIPI_LANE_NUM_DOL == 4)
+static int pCus_init_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt=0;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //    short sen_data;
+    //sensor_if->PCLK( CUS_SNR_PCLK_MIPI_TOP );//sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    if (pCus_CheckSonyProductID(handle)) {
+        return FAIL;
+    }
+
+    //UartSendTrace("IMX307 Sensor_init_table_HDR_DOL_4lane\n");
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane[i].reg,Sensor_init_table_HDR_DOL_4lane[i].data) != SUCCESS)
+            {
+                cnt++;
+                //UartSendTrace("Sensor_init_table_HDR_DOL_4lane -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //UartSendTrace("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //SensorReg_Read( Sensor_init_table_HDR_DOL_4lane[i].reg, &sen_data );
+            //UartSendTrace("IMX307 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane[i].reg, Sensor_init_table_HDR_DOL_4lane[i].data, sen_data);
+        }
+    }
+
+    params->tVts_reg[0].data = (params->expo.vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (params->expo.vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (params->expo.vts >> 0) & 0x00ff;
+
+    //UartSendTrace("[%s:%d]Sensor init success!!\n", __FUNCTION__, __LINE__);
+    return SUCCESS;
+}
+#endif
+
+#if 1//(SENSOR_MIPI_LANE_NUM_DOL == 2)
+static int pCus_init_mipi2lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt=0;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //    short sen_data;
+    //sensor_if->PCLK( CUS_SNR_PCLK_MIPI_TOP );//sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    if (pCus_CheckSonyProductID(handle)) {
+        return FAIL;
+    }
+
+    //UartSendTrace("IMX307 Sensor_init_table_HDR_DOL_2lane\n");
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_2lane);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_2lane[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_2lane[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_2lane[i].reg,Sensor_init_table_HDR_DOL_2lane[i].data) != SUCCESS)
+            {
+                cnt++;
+                //UartSendTrace("Sensor_init_table_HDR_DOL_2lane -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //UartSendTrace("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //SensorReg_Read( Sensor_init_table_HDR_DOL_2lane[i].reg, &sen_data );
+            //UartSendTrace("IMX307 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_2lane[i].reg, Sensor_init_table_HDR_DOL_2lane[i].data, sen_data);
+        }
+    }
+
+    params->tVts_reg[0].data = (params->expo.vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (params->expo.vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (params->expo.vts >> 0) & 0x00ff;
+
+    //UartSendTrace("[%s:%d]Sensor init success!!\n", __FUNCTION__, __LINE__);
+    return SUCCESS;
+}
+#endif
+
+#if 1//(SENSOR_MIPI_LANE_NUM == 2)
+static int pCus_init_mipi2lane_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+	//short sen_data;
+    //sensor_if->PCLK( CUS_SNR_PCLK_MIPI_TOP );//sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    if (pCus_CheckSonyProductID(handle)) {
+        return FAIL;
+    }
+
+    //UartSendTrace("IMX307 Sensor_init_table_2lane\n");
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_2lane);i++)
+    {
+		if(Sensor_init_table_2lane[i].reg==0xffff)
+		{
+			SENSOR_MSLEEP_(Sensor_init_table_2lane[i].data);
+		}
+		else
+		{
+			cnt = 0;
+			while(SensorReg_Write(Sensor_init_table_2lane[i].reg,Sensor_init_table_2lane[i].data) != SUCCESS)
+			{
+				cnt++;
+				//printf("Sensor_init_table_2lane -> Retry %d...\n",cnt);
+				if(cnt>=10)
+				{
+					//printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+					return FAIL;
+				}
+				//usleep(10*1000);
+			}
+			//SensorReg_Read( Sensor_init_table_2lane[i].reg, &sen_data );
+			//UartSendTrace("IMX307 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_2lane[i].reg, Sensor_init_table_2lane[i].data, sen_data);
+		}
+	}
+
+    for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+    {
+        if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+        {
+            //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+            return FAIL;
+        }
+    }
+
+    for(i=0;i< ARRAY_SIZE(TriggerStartTbl);i++)
+    {
+        if(SensorReg_Write(TriggerStartTbl[i].reg,TriggerStartTbl[i].data) != SUCCESS)
+        {
+            //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+            return FAIL;
+        }
+    }
+
+    pCus_SetOrien(handle, handle->orient);
+
+    //pCus_SetAEGain(handle,2048);
+    //pCus_SetAEUSecs(handle, 25000);
+    //pCus_SetFPS(handle, 25000);
+    //MSG("[%s:%d]Sensor init success!!\n", __FUNCTION__, __LINE__);
+    return SUCCESS;
+}
+#endif
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+
+            if(lane_num == 2)
+                 handle->pCus_sensor_init = pCus_init_mipi2lane_linear;
+            else if (lane_num == 4)
+                handle->pCus_sensor_init = pCus_init_mipi4lane_linear;
+            else
+              handle->pCus_sensor_init = pCus_init_mipi2lane_linear;
+
+            params->expo.vts=vts_30fps;
+            break;
+
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            if(hdr_lane_num == 2) {
+                handle->pCus_sensor_init = pCus_init_mipi2lane_HDR_DOL;
+                params->expo.vts = vts_30fps_HDR_DOL_2lane;
+            } else if(hdr_lane_num == 4) {
+                handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL;
+                params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            }
+
+            break;
+
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+#if 0
+    imx307_params *params = (imx307_params *)handle->private_data;
+    short sen_data;
+
+    SensorReg_Read(0x3007, &sen_data);//always success now
+
+    //LOGD("mirror:%x\r\n", sen_data & 0x03);
+    switch(sen_data & 0x03)
+    {
+        case 0x00:
+            *orit = CUS_ORIT_M0F0;
+        break;
+        case 0x02:
+            *orit = CUS_ORIT_M1F0;
+        break;
+        case 0x01:
+            *orit = CUS_ORIT_M0F1;
+        break;
+        case 0x03:
+            *orit = CUS_ORIT_M1F1;
+        break;
+    }
+#endif
+    *orit = handle->orient;
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    handle->orient = orit;
+    params->orien_dirty = true;
+
+    return SUCCESS;
+}
+
+static int DoOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    int table_length = ARRAY_SIZE(mirr_flip_table);
+    int seg_length=table_length/4;
+    int i,j;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            for(i=0,j=0;i<seg_length;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                handle->orient = CUS_ORIT_M0F0;
+            }
+            break;
+
+        case CUS_ORIT_M1F0:
+            for(i=seg_length,j=0;i<seg_length*2;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                handle->orient = CUS_ORIT_M1F0;
+            }
+            break;
+
+        case CUS_ORIT_M0F1:
+            for(i=seg_length*2,j=0;i<seg_length*3;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                handle->orient = CUS_ORIT_M0F1;
+            }
+            break;
+
+        case CUS_ORIT_M1F1:
+            for(i=seg_length*3,j=0;i<seg_length*4;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                handle->orient = CUS_ORIT_M1F1;
+            }
+            break;
+
+        default :
+            for(i=0,j=0;i<seg_length;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                handle->orient = CUS_ORIT_M0F0;
+            }
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 3000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts = 0;
+    imx307_params *params = (imx307_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    if(fps>=3 && fps <= 30){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            fps = fps>29?29:fps;//limit fps at 29 fps due to MCLK=36MHz
+        params->expo.fps = fps;
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            params->expo.vts=  (vts_30fps*29091 + fps * 500)/(fps * 1000);
+        else
+            params->expo.vts=  (vts_30fps*30000 + fps * 500)/(fps * 1000);
+        params->dirty = true;
+    }else if(fps>=3000 && fps <= 30000){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            fps = fps>29091?29091:fps;//limit fps at 29.091 fps due to MCLK=36MHz
+        params->expo.fps = fps;
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            params->expo.vts=  (vts_30fps*29091 + (fps>>1))/fps;
+        else
+            params->expo.vts=  (vts_30fps*30000 + (fps>>1))/fps;
+        params->dirty = true;
+    }else{
+      //params->expo.vts=vts_30fps;
+      //params->expo.fps=30;
+      SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+      return FAIL;
+    }
+    if(params->expo.expo_lines > params->expo.vts -2){
+        vts = params->expo.expo_lines + 8;
+    }else{
+        vts = params->expo.vts;
+    }
+
+    params->expo.vts = vts;
+
+    pCus_SetAEUSecs(handle, params->expo.expo_lef_us);
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_SEF1(ms_cus_sensor *handle)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if(2 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_2lane;
+    }
+    else if(4 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    }
+
+    if (params->expo.fps >= 3000)
+        params->expo.preview_fps = (cur_vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (cur_vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_SEF1(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts = 0, cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    imx307_params *params = (imx307_params *)handle->private_data;
+
+    if(2 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps =vts_30fps_HDR_DOL_2lane;
+    }
+    else if(4 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    }
+
+    params->expo.fps = fps;
+
+    if(fps>=3 && fps <= 30){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            fps = fps>29?29:fps;//limit fps at 29 fps due to MCLK=36MHz
+        params->expo.fps = fps;
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            params->expo.vts= (cur_vts_30fps*29091 + fps * 500 )/ (fps * 1000);
+        else
+            params->expo.vts= (cur_vts_30fps*30000 + fps * 500 )/ (fps * 1000);
+        params->dirty = true;
+    }else if(fps>=3000 && fps <= 30000){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            fps = fps>29091?29091:fps;//limit fps at 29.091 fps due to MCLK=36MHz
+        params->expo.fps = fps;
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            params->expo.vts= (cur_vts_30fps*29091 + (fps >> 1))/fps;
+        else
+            params->expo.vts= (cur_vts_30fps*30000 + (fps >> 1))/fps;
+        params->dirty = true;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > 2 * params->expo.vts - params->max_rhs1 -3){
+       vts = (params->expo.expo_lines + params->max_rhs1 + 3 + 1) / 2;
+    }else{
+       vts = params->expo.vts;
+    }
+
+    params->expo.vts = vts;
+    pCus_SetAEUSecsHDR_DOL_SEF1(handle, params->expo.expo_sef_us);
+    params->skip_cnt = 1;
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap)
+{
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1);
+
+                if(params->dirty)
+                {
+                    SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                    params->dirty = false;
+                }
+
+                if(params->orien_dirty)
+                {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+
+                SensorReg_Write(0x3001,0);         // printf("0x3009=0x%x,0x3014=0x%x,0x3016=0x%x,0x3020=0x%x,0x3021=0x%x\n", params->tGain_reg[1].data,params->tGain_reg[0].data,params->tGain_reg[2].data,params->tExpo_reg[2].data,params->tExpo_reg[1].data);
+            }
+
+            if(params->skip_cnt){
+                sensor_if->SetSkipFrame(handle->snr_pad_group, params->expo.fps, params->skip_cnt);
+                params->skip_cnt = 0;
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_SEF1(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    //imx307_params *params = (imx307_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us)
+{
+    //int rc;
+    u32 lines = 0;
+    imx307_params *params = (imx307_params *)handle->private_data;
+    //int rc = SensorRegArrayR((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+
+    lines |= (u32)(params->tExpo_reg[0].data&0xff)<<16;
+    lines |= (u32)(params->tExpo_reg[1].data&0xff)<<8;
+    lines |= (u32)(params->tExpo_reg[2].data&0xff)<<0;
+   // lines >>= 4;
+   // *us = (lines+dummy) * params->expo.us_per_line;
+    //*us = lines;//(lines*Preview_line_period);
+    *us = (lines*Preview_line_period)/1000;
+    SENSOR_DMSG("[%s] sensor expo lines/us %u,%u us\n", __FUNCTION__, lines, *us);
+    //return rc;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, vts = 0;
+    imx307_params *params = (imx307_params *)handle->private_data;
+
+    params->expo.expo_lef_us = us;
+    lines = (1000*us)/Preview_line_period;
+
+    if (lines <1 ) lines = 1;
+
+    params->expo.expo_lines = lines;
+
+    if (lines >params->expo.vts-2) {
+        vts = lines +2;
+    }
+    else
+      vts=params->expo.vts;
+
+    SENSOR_DMSG("[%s] us %u, lines %u, vts %u\n", __FUNCTION__,
+                us,
+                lines,
+                params->expo.vts
+                );
+    lines=vts-lines-1;
+    params->tExpo_reg[0].data = (lines>>16) & 0x0003;
+    params->tExpo_reg[1].data = (lines>>8) & 0x00ff;
+    params->tExpo_reg[2].data = (lines>>0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF1(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, cur_line_period = Preview_line_period_HDR_DOL_4LANE, cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    u32 rhs1 = 0, shs1 = 0, vts = 0;
+    imx307_params *params = (imx307_params *)handle->private_data;
+
+    params->expo.expo_sef_us = us;
+
+    if(2 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_line_period = Preview_line_period_HDR_DOL_2LANE;
+    }
+    else if(4 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    }
+
+    if(2 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps =vts_30fps_HDR_DOL_2lane;
+    }
+    else if(4 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    }
+
+    lines = (1000 * us + (cur_line_period >> 1)) / cur_line_period;
+
+    //check fps to set rhs1
+
+    if(params->expo.fps > 3000){ //3fps*1000
+        if(params->expo.fps > 25000){
+            if(lines > 98) {
+                params->max_rhs1 = 211;
+                params->expo.vts = cur_vts_30fps * 30000 / 25000;
+            }
+            else{
+                params->expo.vts = cur_vts_30fps * 30000 / params->expo.fps;
+                params->max_rhs1 = 101;
+            }
+        }
+        else
+    	    params->max_rhs1 = 211;
+    }
+    else {
+        if(params->expo.fps > 25){
+            if(lines > 98) {
+                params->max_rhs1 = 211;
+                params->expo.vts = cur_vts_30fps * 30 / 25;
+            }
+            else{
+                params->expo.vts = cur_vts_30fps * 30 / params->expo.fps;
+                params->max_rhs1 = 101;
+            }
+        }
+        else
+    	    params->max_rhs1 = 211;
+    }
+
+    if (params->expo.expo_lines > 2 * params->expo.vts - params->max_rhs1 - 3) {
+        vts = (params->expo.expo_lines + params->max_rhs1 + 3 + 1) / 2;
+    }
+    else{
+        vts = params->expo.vts;
+    }
+
+    rhs1 = params->max_rhs1;
+    //Check boundary
+	if(lines < 1)
+		lines = 1;
+	if(lines > rhs1- 3)
+    	lines = rhs1 - 3;
+
+    if((rhs1 - 1 - 2) <= lines){
+        shs1 = 2;
+    }
+    else if((rhs1 <= params->max_rhs1) && (rhs1 <= params->lef_shs2 - 2)){
+        shs1 = rhs1 - 1 - lines;
+        if((shs1 < 2) || (shs1 > (rhs1 - 2))){ //Check boundary
+            //shs1 = 0;
+            //UartSendTrace("[SEF1 NG1]");
+        }
+    }
+    else{
+        //UartSendTrace("[SEF1 NG2]");
+    }
+    params->tVts_reg[0].data = (vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->tExpo_reg[0].data = (shs1 >> 16) & 0x0003;
+    params->tExpo_reg[1].data = (shs1 >> 8) & 0x00ff;
+    params->tExpo_reg[2].data = (shs1 >> 0) & 0x00ff;
+
+    params->tRhs1_reg[0].data = (params->max_rhs1 >> 16) & 0x0003;
+    params->tRhs1_reg[1].data = (params->max_rhs1 >> 8) & 0x00ff;
+    params->tRhs1_reg[2].data = (params->max_rhs1 >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain)
+{
+    //int rc = SensorRegArrayR((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+    unsigned short temp_gain;
+  //  *gain=params->expo.final_gain;
+    temp_gain=gain_reg[0].data;
+
+    *gain=(u32)(10^((temp_gain*3)/200))*1024;
+    if (gain_reg[1].data & 0x10)
+       *gain = (*gain) * 2;
+
+    SENSOR_DMSG("[%s] get gain/reg (1024=1X)= %u/0x%x\n", __FUNCTION__, *gain,gain_reg[0].data);
+    //return rc;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    //double gain_double;
+    u64 gain_double;
+    params->expo.final_gain = gain;
+
+    if(gain<1024)
+       gain=1024;
+    else if(gain>=3980*1024)
+        gain=3980*1024;
+
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    params->tGain_reg[0].data=(u16)(((gain_double*10)>> 24)/3);
+
+    //gain_double = 20*log10((double)gain/1024);
+    //params->tGain_reg[0].data=(u16)((gain_double*10)/3);
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data);
+
+    //return CusHW_i2c_array_tx(handle, handle->i2c_cfg, params->tGain_reg, sizeof(gain_reg)/sizeof(CUS_I2C_ARRAY));
+    //return SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, sizeof(gain_reg)/sizeof(I2C_ARRAY));
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain)
+{
+    //extern DBG_ITEM Dbg_Items[DBG_TAG_MAX];
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u32 i;//, gain_before=0;
+    CUS_GAIN_GAP_ARRAY* Sensor_Gain_Linearity;
+    //double gain_double;
+    u64 gain_double;
+
+    //return SUCCESS; //TBD
+
+   // u32 times = log2((double)gain/1024.0f)/log(2);
+    params->expo.final_gain = gain;
+    if(gain < SENSOR_MIN_GAIN)
+        gain = SENSOR_MIN_GAIN;
+    else if(gain >= SENSOR_MAX_GAIN)
+        gain = SENSOR_MAX_GAIN;
+    Sensor_Gain_Linearity = gain_gap_compensate;
+
+    for(i = 0; i < sizeof(gain_gap_compensate)/sizeof(CUS_GAIN_GAP_ARRAY); i++){
+        //LOGD("GAP:%x %x\r\n",Sensor_Gain_Linearity[i].gain, Sensor_Gain_Linearity[i].offset);
+
+        if (Sensor_Gain_Linearity[i].gain == 0)
+            break;
+        if((gain>Sensor_Gain_Linearity[i].gain) && (gain < (Sensor_Gain_Linearity[i].gain + Sensor_Gain_Linearity[i].offset))){
+              gain=Sensor_Gain_Linearity[i].gain;
+              break;
+        }
+    }
+
+    if(gain>=22925)//if gain exceed 2x , enable high conversion gain, >27DB, enable HCG
+    {
+
+           if(params->tGain_reg[1].data==0x02){
+           // params->change = true;
+            // gain_reg[2].data=0x08;
+            }
+           else{
+           // params->change = false;
+          //  gain_reg[2].data=0x09;
+            }
+            //gain_before=gain;
+            params->tGain_reg[1].data |= 0x10;
+           // gain_reg[2].data=0x08;
+            gain /= 2;
+
+    }
+    else{
+
+           if(params->tGain_reg[1].data==0x12){
+           // params->change = true;
+           //  gain_reg[2].data=0x08;
+            }
+           else{
+           // params->change = false;
+           // gain_reg[2].data=0x09;
+            }
+          //  printf("[%s] params->change=%d\n", __FUNCTION__, params->change);
+
+           // gain_before=gain;
+            params->tGain_reg[1].data &= ~0x10;
+            //gain_reg[2].data=0x09;
+
+        }
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    params->tGain_reg[0].data=(u16)(((gain_double*10)>> 24)/3);
+    //gain_double = 20*log10((double)gain/1024);
+    //params->tGain_reg[0].data=(u16)((gain_double*10)/3);
+
+    //SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+
+    //LOGD("s:%x %x\r\n", params->tGain_reg[0].data, params->tGain_reg[1].data);
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data);
+    params->dirty = true;
+    return SUCCESS;
+    //return CusHW_i2c_array_tx(handle, handle->i2c_cfg, params->tGain_reg, sizeof(gain_reg)/sizeof(CUS_I2C_ARRAY));
+   // return SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, sizeof(gain_reg)/sizeof(I2C_ARRAY));
+}
+
+static void pCus_SetAEGainHDR_DOL_Calculate(u32 gain, u16 *gain_reg)
+{
+    //double gain_double;
+    u64 gain_double;
+
+    if(gain < SENSOR_MIN_GAIN){
+      gain = SENSOR_MIN_GAIN;
+    }
+    else if(gain >= SENSOR_MAX_GAIN){
+      gain = SENSOR_MAX_GAIN;
+    }
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    *gain_reg=(u16)(((gain_double*10)>> 24)/3);
+    //gain_double = 20*log10((double)gain/1024);  //gain to db
+    //*gain_reg = (u16)((gain_double*10)/3); //db to sensor reg
+}
+
+static int pCus_SetAEGainHDR_DOL_SEF1(ms_cus_sensor *handle, u32 gain)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_sef_reg[0].data = gain_reg;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_sef_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = SENSOR_MIN_GAIN;//handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;//3980*1024;
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetDGainRemainder(ms_cus_sensor *handle, u32 *dgain_remainder)
+{
+    *dgain_remainder = handle->dgain_remainder;
+
+    return SUCCESS;
+}
+#endif
+static int IMX307_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = (Preview_line_period * 1);
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+    u32 i, j;
+
+    for(i=0,j=0;i< num ;i++,j+=2){
+        gain_gap_compensate[i].gain=pArray[i].gain;
+        gain_gap_compensate[i].offset=pArray[i].offset;
+    }
+
+    //LOGD("[%s]%d, %d, %d, %d\n", __FUNCTION__, num, pArray[0].gain, pArray[1].gain, pArray[num-1].offset);
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx307_params *params;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx307_params *)handle->private_data;
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tRhs1_reg, expo_RHS1_reg, sizeof(expo_RHS1_reg));
+    memcpy(params->tShs2_reg, expo_SHS2_reg, sizeof(expo_SHS2_reg));
+    memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+    memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF1_reg, sizeof(gain_HDR_DOL_SEF1_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX307_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = lane_num;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth = 0x79C;
+    handle->video_res_supported.res[0].nOutputHeight = 0x449;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "1920x1080@30fps");
+    // i2c
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay    = SENSOR_SHUTTER_DELAY_FRAME_COUNT;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 2;
+
+    ///calibration
+    handle->sat_mingain = SENSOR_MIN_GAIN;//g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+
+    if(lane_num == 2)
+        handle->pCus_sensor_init        = pCus_init_mipi2lane_linear    ;
+    else if(lane_num == 4)
+        handle->pCus_sensor_init        = pCus_init_mipi4lane_linear    ;
+    else
+      handle->pCus_sensor_init        = pCus_init_mipi2lane_linear    ;
+
+    //handle->pCus_sensor_powerupseq  = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron     = pCus_poweron ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = imx307_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = IMX307_GetShutterInfo;
+
+    params->expo.vts=vts_30fps;
+    params->expo.expo_lines = 673;
+    if (CUS_CMU_CLK_36MHZ == handle->mclk)
+        params->expo.fps = 29;
+    else
+        params->expo.fps = 30;
+    params->dirty = false;
+
+    return SUCCESS;
+}
+
+static int IMX307_GetShutterInfo_hdr_dol_sef1(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = Preview_line_period_HDR_DOL_4LANE * 211;
+    info->min = (Preview_line_period_HDR_DOL_4LANE * 2);
+    info->step = Preview_line_period_HDR_DOL_4LANE;
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_sef1(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx307_params *params = NULL;
+
+    cus_camsensor_init_handle(drv_handle);
+    params = (imx307_params *)handle->private_data;
+
+    sprintf(handle->model_id,"IMX307_MIPI_HDR_SEF");
+
+    handle->bayer_id    = SENSOR_BAYERID_HDR_DOL;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->data_prec   = SENSOR_DATAPREC_DOL;
+    handle->interface_attr.attr_mipi.mipi_lane_num = hdr_lane_num;
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_SONY_DOL;
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT_HDR_DOL; //TBD. Workaround for Sony DOL HDR mode
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth = 0x79C;
+    handle->video_res_supported.res[0].nOutputHeight = 0x449;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "1920x1080@30fps_HDR");
+
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes_HDR_DOL;
+
+    if(hdr_lane_num == 4)
+        handle->pCus_sensor_init        = pCus_init_mipi4lane_HDR_DOL;
+    else if(hdr_lane_num == 2)
+        handle->pCus_sensor_init        = pCus_init_mipi2lane_HDR_DOL;
+    else
+      handle->pCus_sensor_init        = pCus_init_mipi4lane_HDR_DOL;
+
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_HDR_DOL_SEF1;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_HDR_DOL_SEF1;
+    handle->pCus_sensor_GetOrien        = pCus_GetOrien;
+    handle->pCus_sensor_SetOrien        = pCus_SetOrien;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotifyHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_SEF1;
+    handle->pCus_sensor_GetShutterInfo = IMX307_GetShutterInfo_hdr_dol_sef1;
+
+    if(hdr_lane_num == 4)
+        params->expo.vts = vts_30fps_HDR_DOL_4lane;
+    else if(hdr_lane_num == 2)
+        params->expo.vts = vts_30fps_HDR_DOL_2lane;
+    else
+        params->expo.vts = vts_30fps_HDR_DOL_4lane;
+
+
+    params->expo.expo_lines = 673;
+
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+
+    handle->ae_gain_delay       = SENSOR_GAIN_DELAY_FRAME_COUNT_DOL;
+    handle->ae_shutter_delay    = SENSOR_SHUTTER_DELAY_FRAME_COUNT_DOL;
+
+    handle->ae_gain_ctrl_num = 2;
+    handle->ae_shutter_ctrl_num = 2;
+
+    return SUCCESS;
+}
+#if 1//(SENSOR_MIPI_LANE_NUM == 4)
+static int pCus_init_mipi4lane_linear_isp_calibration(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+#endif
+#if 1//(SENSOR_MIPI_LANE_NUM == 2)
+static int pCus_init_mipi2lane_linear_isp_calibration(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+#endif
+static int pCus_poweron_isp_calibration( ms_cus_sensor *handle, u32 idx)
+{
+    //ISensorIfAPI *sensor_if = &handle->sensor_if_api;
+    //SENSOR_DMSG( "[%s] ", __FUNCTION__ );
+
+    return SUCCESS;
+}
+
+static int pCus_poweroff_isp_calibration( ms_cus_sensor *handle, u32 idx)
+{
+    //ISensorIfAPI *sensor_if = &handle->sensor_if_api;
+    //SENSOR_DMSG( "[%s] power low\n", __FUNCTION__ );
+
+    return SUCCESS;
+}
+
+static int pCus_GetSensorID_isp_calibration( ms_cus_sensor *handle, u32 *id )
+{
+    *id = 0;
+     return SUCCESS;
+}
+
+static int imx307_SetPatternMode_isp_calibration( ms_cus_sensor *handle, u32 mode )
+{
+    return SUCCESS;
+}
+#if 0
+static int pCus_I2CWrite_isp_calibration(ms_cus_sensor *handle, unsigned short usreg, unsigned short usval)
+{
+    return SUCCESS;
+}
+
+static int pCus_I2CRead_isp_calibration(ms_cus_sensor *handle, unsigned short usreg)
+{
+    return SUCCESS;
+}
+
+static int pCus_init_isp_calibration( ms_cus_sensor *handle )
+{
+    return SUCCESS;
+}
+#endif
+static int pCus_GetVideoRes_isp_calibration( ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res )
+{
+    *res = &handle->video_res_supported.res[res_idx];
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_isp_calibration( ms_cus_sensor *handle, u32 res )
+{
+    handle->video_res_supported.ulcur_res = 0; //TBD
+    return SUCCESS;
+}
+
+static int pCus_GetOrien_isp_calibration( ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit )
+{
+    //imx307_params *params = ( imx307_params * ) handle->private_data;
+    //return params->mirror_flip.cur;
+	return SUCCESS;
+}
+
+static int pCus_SetOrien_isp_calibration( ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit )
+{
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_isp_calibration( ms_cus_sensor *handle )
+{
+    return SUCCESS;
+}
+
+static int pCus_SetFPS_isp_calibration( ms_cus_sensor *handle, u32 fps )
+{
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetSensorCap_isp_calibration( ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap )
+{
+    if( cap )
+        memcpy( cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP) );
+    else
+        return FAIL;
+    return SUCCESS;
+}
+#endif
+static int pCus_AEStatusNotify_isp_calibration( ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status )
+{
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs_isp_calibration( ms_cus_sensor *handle, u32 *us )
+{
+    *us = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs_isp_calibration( ms_cus_sensor *handle, u32 us )
+{
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain_isp_calibration( ms_cus_sensor *handle, u32* gain )
+{
+    *gain = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain_cal_isp_calibration( ms_cus_sensor *handle, u32 gain )
+{
+    return SUCCESS;
+}
+static int pCus_SetAEGain_isp_calibration( ms_cus_sensor *handle, u32 gain )
+{
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs_isp_calibration( ms_cus_sensor *handle, u32 *min, u32 *max )
+{
+    *min = 1;
+    *max = 1000000 / 30;
+
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain_isp_calibration( ms_cus_sensor *handle, u32 *min, u32 *max )
+{
+    *min = 1024;            //1024*1.1*2
+    *max = 1024*8;
+
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity_isp_calibration( ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num )
+{
+    return SUCCESS;
+}
+
+static int IMX307_GetShutterInfo_isp_calibration( struct __ms_cus_sensor* handle, CUS_SHUTTER_INFO *info )
+{
+    info->max = 1000000000 / 12;
+    info->min = Preview_line_period;
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetDGainRemainder_isp_calibration(ms_cus_sensor *handle, u32 *dgain_remainder)
+{
+   return SUCCESS;
+}
+#endif
+int cus_camsensor_init_handle_linear_isp_calibration(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx307_params *params;
+#if defined(__RTK_OS__)
+    //CamOsRet_e                  eCamOsRet = CAM_OS_OK;
+    void*                       pvBufVirt = NULL;
+    //u64                 u64BufPhy = 0;
+    //u64                 u64BufMiu = 0;
+    char str[20];
+#endif
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+#if defined(__RTK_OS__)
+    sprintf(str, "IMX307linear");
+    //eCamOsRet = CamOsDirectMemAlloc(str, sizeof(imx307_params), &pvBufVirt, &u64BufMiu, &u64BufPhy);
+    pvBufVirt = CamOsMemAlloc(sizeof(imx307_params));
+    if (pvBufVirt == NULL) {
+        //UartSendTrace("[%s:%d] fail!\n", __FUNCTION__, __LINE__);
+        return FAIL;
+    }
+    handle->private_data = (imx307_params *)pvBufVirt;
+    memset(handle->private_data, 0, sizeof(imx307_params));
+#else
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+#endif
+    params = (imx307_params *)handle->private_data;
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tRhs1_reg, expo_RHS1_reg, sizeof(expo_RHS1_reg));
+    memcpy(params->tShs2_reg, expo_SHS2_reg, sizeof(expo_SHS2_reg));
+    memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+    memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF1_reg, sizeof(gain_HDR_DOL_SEF1_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX307_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = lane_num;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+    sprintf(handle->video_res_supported.res[0].strResDesc, "1920x1080@30fps");
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+	handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+	handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth = 0x79C;
+    handle->video_res_supported.res[0].nOutputHeight = 0x449;
+
+    // i2c
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay    = SENSOR_SHUTTER_DELAY_FRAME_COUNT;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 2;
+
+    ///calibration
+    handle->sat_mingain = SENSOR_MIN_GAIN;//g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+
+    if(lane_num == 2)
+        handle->pCus_sensor_init        = pCus_init_mipi2lane_linear_isp_calibration    ;
+    else if(lane_num == 4)
+        handle->pCus_sensor_init        = pCus_init_mipi4lane_linear_isp_calibration    ;
+    else
+      handle->pCus_sensor_init        = pCus_init_mipi2lane_linear_isp_calibration    ;
+
+    //handle->pCus_sensor_powerupseq  = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron     = pCus_poweron_isp_calibration ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff_isp_calibration;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID_isp_calibration   ;
+    //handle->pCus_sensor_GetStillResCap    = pCus_GetStillResCap;
+    //handle->pCus_sensor_GetStillRes       = pCus_GetStillRes   ;
+    //handle->pCus_sensor_SetStillRes       = pCus_SetStillRes   ;
+    //handle->pCus_sensor_GetVideoResCap    = pCus_GetVideoResCap;
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes_isp_calibration   ;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes_isp_calibration   ;
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien_isp_calibration      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien_isp_calibration      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_isp_calibration      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_isp_calibration      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap_isp_calibration;
+    handle->pCus_sensor_SetPatternMode = imx307_SetPatternMode_isp_calibration;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify_isp_calibration;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs_isp_calibration;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs_isp_calibration;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain_isp_calibration;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain_isp_calibration;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain_isp_calibration;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_isp_calibration;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder_isp_calibration;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal_isp_calibration;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity_isp_calibration;
+    handle->pCus_sensor_GetShutterInfo = IMX307_GetShutterInfo_isp_calibration;
+#if 0//defined(__MV5_FPGA__)
+	handle->pCus_sensor_I2CWrite = pCus_I2CWrite_isp_calibration; //Andy Liu
+	handle->pCus_sensor_I2CRead = pCus_I2CRead_isp_calibration; //Andy Liu
+#endif
+    params->expo.vts=vts_30fps;
+    params->expo.expo_lines = 673;
+    if (CUS_CMU_CLK_36MHZ == handle->mclk)
+        params->expo.fps = 29;
+    else
+        params->expo.fps = 30;
+    params->dirty = false;
+
+    return SUCCESS;
+}
+//lef functions
+static int pCus_init_hdr_dol_lef(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweron_hdr_dol_lef(ms_cus_sensor *handle, u32 idx)
+{
+#if 0
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG( "[%s] ", __FUNCTION__ );
+
+    sensor_if->PowerOff(CUS_SENSOR_PAD_GROUP_B/*TBD?*/, !handle->pwdn_POLARITY );
+    MsSleep(RTK_MS_TO_TICK(10));//usleep( 500 );
+
+    //sensor_if->Reset(CUS_SENSOR_PAD_GROUP_B, !handle->reset_POLARITY );
+    //MsSleep(RTK_MS_TO_TICK(5));//usleep( 500 );
+
+    // pure power on
+    sensor_if->PowerOff(CUS_SENSOR_PAD_GROUP_B/*TBD?*/, !handle->pwdn_POLARITY );
+#endif
+    return SUCCESS;
+}
+
+static int pCus_poweroff_hdr_dol_lef(ms_cus_sensor *handle, u32 idx)
+{
+#if 0
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG( "[%s] power low\n", __FUNCTION__ );
+
+    sensor_if->PowerOff(CUS_SENSOR_PAD_GROUP_B/*TBD?*/, handle->pwdn_POLARITY );
+    MsSleep(RTK_MS_TO_TICK(5));//usleep( 1000 );
+#endif
+    return SUCCESS;
+}
+
+static int pCus_GetSensorID_hdr_dol_lef(ms_cus_sensor *handle, u32 *id)
+{
+    *id = 0;
+     return SUCCESS;
+}
+#if 0
+static int pCus_GetOrien_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    *orit = CUS_ORIT_M0F0;
+    return SUCCESS;
+}
+
+static int pCus_SetOrien_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    return SUCCESS;
+}
+#endif
+
+static int pCus_GetFPS_hdr_dol_lef(ms_cus_sensor *handle)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if(2 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_2lane;
+    }
+    else if(4 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    }
+
+    if (params->expo.fps >= 3000)
+        params->expo.preview_fps = (cur_vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (cur_vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_hdr_dol_lef(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts = 0, cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    imx307_params *params = (imx307_params *)handle->private_data;
+
+    if(2 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_2lane;
+    }
+    else if(4 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    }
+
+    if(fps>=3 && fps <= 30){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            fps = fps>29?29:fps;//limit fps at 29 fps due to MCLK=36MHz
+        params->expo.fps = fps;
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            params->expo.vts=  (cur_vts_30fps*29091 + fps * 500 )/ (fps * 1000);
+        else
+            params->expo.vts=  (cur_vts_30fps*30000 + fps * 500 )/ (fps * 1000);
+        params->dirty = true;
+    }else if(fps>=3000 && fps <= 30000){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            fps = fps>29091?29091:fps;//limit fps at 29.091 fps due to MCLK=36MHz
+        params->expo.fps = fps;
+        if (CUS_CMU_CLK_36MHZ == handle->mclk)
+            params->expo.vts=  (cur_vts_30fps*29091 + (fps >> 1))/fps;
+        else
+            params->expo.vts=  (cur_vts_30fps*30000 + (fps >> 1))/fps;
+        params->dirty = true;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > 2 * params->expo.vts - params->max_rhs1 -3){
+        vts = (params->expo.expo_lines + params->max_rhs1 + 3 + 1) / 2;
+    }else{
+        vts = params->expo.vts;
+    }
+
+    params->expo.vts = vts;
+    params->skip_cnt = 1;
+    pCus_SetAEUSecsHDR_DOL_LEF(handle, params->expo.expo_lef_us);
+
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetSensorCap_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap)
+{
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+static int imx307_SetPatternMode_hdr_dol_lef(ms_cus_sensor *handle,u32 mode)
+{
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+        	if(params->dirty || params->orien_dirty)
+            {
+                SensorReg_Write(0x3001,1);
+                SensorRegArrayW((I2C_ARRAY*)params->tShs2_reg, ARRAY_SIZE(expo_SHS2_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tRhs1_reg, ARRAY_SIZE(expo_RHS1_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_lef_reg, ARRAY_SIZE(gain_HDR_DOL_LEF_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_sef_reg, ARRAY_SIZE(gain_HDR_DOL_SEF1_reg));
+                params->dirty = false;
+
+                if(params->orien_dirty)
+                {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+            }
+
+            if(params->skip_cnt){
+            	sensor_if->SetSkipFrame(handle->snr_pad_group, params->expo.fps, params->skip_cnt);
+                params->skip_cnt = 0;
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs_hdr_dol_lef(ms_cus_sensor *handle, u32 *us)
+{
+    *us = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 vts = 0, fsc = 0, cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    //u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    imx307_params *params = (imx307_params *)handle->private_data;
+
+    params->expo.expo_lef_us = us;
+
+    if(2 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_line_period = Preview_line_period_HDR_DOL_2LANE;
+        //cur_vts_30fps =vts_30fps_HDR_DOL_2lane;
+    }
+    else if(4 == handle->interface_attr.attr_mipi.mipi_lane_num)
+    {
+        cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+        //cur_vts_30fps =vts_30fps_HDR_DOL_4lane;
+    }
+
+    params->expo.expo_lines = (1000 * us + (cur_line_period >> 1)) / cur_line_period;
+
+    if (params->expo.expo_lines > 2 * params->expo.vts - params->max_rhs1 - 3) {
+        vts = (params->expo.expo_lines + params->max_rhs1 + 3 + 1) / 2;
+    }
+    else{
+        vts = params->expo.vts;
+    }
+
+   // lines=us/Preview_line_period_HDR_DOL_4LANE;
+    SENSOR_DMSG("[%s] us %u, lines %u, vts %u\n", __FUNCTION__,
+                us,
+                params->expo.expo_lines,
+                params->expo.vts
+                );
+
+    fsc = vts * 2;
+
+    if(params->expo.expo_lines <= 1) {
+    	params->expo.expo_lines = 1;
+    }
+
+	if(params->expo.expo_lines > fsc - 104) {
+		params->expo.expo_lines = fsc - 104;
+	}
+
+	params->lef_shs2 = fsc - params->expo.expo_lines - 1;
+
+    params->tShs2_reg[0].data = (params->lef_shs2 >> 16) & 0x0003;
+    params->tShs2_reg[1].data = (params->lef_shs2 >> 8) & 0x00ff;
+    params->tShs2_reg[2].data = (params->lef_shs2 >> 0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEGain_hdr_dol_lef(ms_cus_sensor *handle, u32* gain)
+{
+    *gain = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGainHDR_DOL_LEF(ms_cus_sensor *handle, u32 gain)
+{
+    imx307_params *params = (imx307_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_lef_reg[0].data = gain_reg;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_lef_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain_hdr_dol_lef(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = handle->sat_mingain;
+    *max = 3980*1024;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs_hdr_dol_lef(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+//static int pCus_GetDGainRemainder(ms_cus_sensor *handle, u32 *dgain_remainder)
+//{
+//    *dgain_remainder = handle->dgain_remainder;
+
+//    return SUCCESS;
+//}
+
+static int pCus_SetAEGain_cal_hdr_dol_lef(ms_cus_sensor *handle, u32 gain)
+{
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity_hdr_dol_lef(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num)
+{
+    return SUCCESS;
+}
+
+static int IMX307_GetShutterInfo_hdr_dol_lef(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = (Preview_line_period_HDR_DOL_4LANE * 5);
+    info->step = Preview_line_period_HDR_DOL_4LANE;
+    return SUCCESS;
+}
+#if 0
+static int pCus_I2CWrite_hdr_dol_lef(ms_cus_sensor *handle, unsigned short usreg, unsigned short usval)
+{
+    return SUCCESS;
+}
+
+static int pCus_I2CRead_hdr_dol_lef(ms_cus_sensor *handle, unsigned short usreg)
+{
+    return SUCCESS;
+}
+#endif
+//
+static int cus_camsensor_init_handle_hdr_dol_lef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx307_params *params;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx307_params *)handle->private_data;
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tRhs1_reg, expo_RHS1_reg, sizeof(expo_RHS1_reg));
+    memcpy(params->tShs2_reg, expo_SHS2_reg, sizeof(expo_SHS2_reg));
+    memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+    memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF1_reg, sizeof(gain_HDR_DOL_SEF1_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX307_MIPI_HDR_LEF");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC_DOL;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID_HDR_DOL;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = hdr_lane_num;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_SONY_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num =  0; //Long frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT_HDR_DOL; //TBD. Workaround for Sony DOL HDR mode
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth = 0x79C;
+    handle->video_res_supported.res[0].nOutputHeight = 0x449;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "1920x1080@30fps_HDR");
+
+    // i2c
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = SENSOR_GAIN_DELAY_FRAME_COUNT_DOL;
+    handle->ae_shutter_delay    = SENSOR_SHUTTER_DELAY_FRAME_COUNT_DOL;
+
+    handle->ae_gain_ctrl_num = 2;
+    handle->ae_shutter_ctrl_num = 2;
+
+    ///calibration
+    handle->sat_mingain = SENSOR_MIN_GAIN;//g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init_hdr_dol_lef;
+    //handle->pCus_sensor_powerupseq  = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron     = pCus_poweron_hdr_dol_lef;
+    handle->pCus_sensor_poweroff    = pCus_poweroff_hdr_dol_lef;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID_hdr_dol_lef;
+
+    handle->pCus_sensor_GetVideoResNum = NULL;
+    handle->pCus_sensor_GetVideoRes       = NULL;
+    handle->pCus_sensor_GetCurVideoRes  = NULL;
+    handle->pCus_sensor_SetVideoRes       = NULL;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_hdr_dol_lef;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_hdr_dol_lef;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap_hdr_dol_lef;
+    handle->pCus_sensor_SetPatternMode = imx307_SetPatternMode_hdr_dol_lef;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotifyHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs_hdr_dol_lef;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain_hdr_dol_lef;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain_hdr_dol_lef;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_LEF;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain_hdr_dol_lef;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_hdr_dol_lef;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal_hdr_dol_lef;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity_hdr_dol_lef;
+    handle->pCus_sensor_GetShutterInfo = IMX307_GetShutterInfo_hdr_dol_lef;
+
+    params->expo.vts = vts_30fps_HDR_DOL_4lane;
+    params->expo.expo_lines = 673;
+    if (CUS_CMU_CLK_36MHZ == handle->mclk)
+        params->expo.fps = 29;
+    else
+        params->expo.fps = 30;
+
+    params->dirty = false;
+
+    return SUCCESS;
+}
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+static CUS_MCLK_FREQ UseParaMclk(const char *mclk)
+{
+/*
+    CUS_CMU_CLK_27MHZ,
+    CUS_CMU_CLK_21P6MHZ,
+    CUS_CMU_CLK_12MHZ,
+    CUS_CMU_CLK_5P4MHZ,
+    CUS_CMU_CLK_36MHZ,
+    CUS_CMU_CLK_54MHZ,
+    CUS_CMU_CLK_43P2MHZ,
+    CUS_CMU_CLK_61P7MHZ,
+    CUS_CMU_CLK_72MHZ,
+    CUS_CMU_CLK_48MHZ,
+    CUS_CMU_CLK_24MHZ,
+    CUS_CMU_CLK_37P125MHZ,
+*/
+    if (strcmp(mclk, "27M") == 0) {
+        return CUS_CMU_CLK_27MHZ;
+    } else if (strcmp(mclk, "12M") == 0) {
+        return CUS_CMU_CLK_12MHZ;
+    } else if (strcmp(mclk, "36M") == 0) {
+        return CUS_CMU_CLK_36MHZ;
+    } else if (strcmp(mclk, "48M") == 0) {
+        return CUS_CMU_CLK_48MHZ;
+    } else if (strcmp(mclk, "54M") == 0) {
+        return CUS_CMU_CLK_54MHZ;
+    } else if (strcmp(mclk, "24M") == 0) {
+        return CUS_CMU_CLK_24MHZ;
+    } else if (strcmp(mclk, "37.125M") == 0) {
+        return CUS_CMU_CLK_37P125MHZ;
+    }
+
+    return Preview_MCLK_SPEED;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(  IMX307_HDR,
+                            cus_camsensor_init_handle,
+                            cus_camsensor_init_handle_hdr_dol_sef1,
+                            cus_camsensor_init_handle_hdr_dol_lef,
+                            imx307_params
+                         );
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_imx335_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_imx335_mipi.c
new file mode 100644
index 00000000..ee11c3b4
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_imx335_mipi.c
@@ -0,0 +1,3707 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(IMX335_HDR);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+//#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+//#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE            CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL   CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+#define ENABLE            1
+#define DISABLE           0
+#undef SENSOR_DBG
+#define SENSOR_DBG        0
+
+#define DEBUG_INFO        0
+
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+//#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+///////////////////////////////////////////////////////////////
+//          @@@                                              //
+//         @ @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//          @@@@                                             //
+//                                                           //
+//      Start Step 1 --  show preview on LCM                 //
+//                                                           //
+//  Fill these #define value and table with correct settings //
+//      camera can work and show preview on LCM              //
+//                                                           //
+///////////////////////////////////////////////////////////////
+
+////////////////////////////////////
+// Sensor-If Info                 //
+////////////////////////////////////
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM        (lane_num)          //IMX335 Linear mode supports MIPI 2/4 Lane
+#define SENSOR_MIPI_LANE_NUM_DOL    (4) //(hdr_lane_num)//IMX335 DOL mode supports MIPI 4 Lane
+//#define SENSOR_MIPI_HDR_MODE        (0) //0: Non-HDR mode. 1:Sony DOL mode
+
+#define SENSOR_ISP_TYPE             ISP_EXT             //ISP_EXT, ISP_SOC (Non-used)
+//#define SENSOR_DATAFMT             CUS_DATAFMT_BAYER    //CUS_DATAFMT_YUV, CUS_DATAFMT_BAYER
+#define SENSOR_IFBUS_TYPE           CUS_SENIF_BUS_MIPI  //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE      PACKET_HEADER_EDGE1
+#define SENSOR_MIPI_HSYNC_MODE_HDR_DOL PACKET_FOOTER_EDGE
+#define SENSOR_DATAPREC             CUS_DATAPRECISION_10
+#define SENSOR_DATAPREC_DOL         CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE             CUS_SEN_10TO12_9098  //CFG
+#define SENSOR_BAYERID              CUS_BAYER_RG         //0h: CUS_BAYER_RG, 1h: CUS_BAYER_GR, 2h: CUS_BAYER_BG, 3h: CUS_BAYER_GB
+#define SENSOR_BAYERID_HDR_DOL      CUS_BAYER_RG
+#define SENSOR_RGBIRID              CUS_RGBIR_NONE
+#define SENSOR_ORIT                 CUS_ORIT_M0F0        //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+//#define SENSOR_YCORDER              CUS_SEN_YCODR_YC     //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+//#define long_packet_type_enable     0x00 //UD1~UD8 (user define)
+
+////////////////////////////////////
+// MCLK Info                      //
+////////////////////////////////////
+#define Preview_MCLK_SPEED          CUS_CMU_CLK_27MHZ    //CUS_CMU_CLK_24MHZ //CUS_CMU_CLK_37P125MHZ//CUS_CMU_CLK_27MHZ
+#define Preview_MCLK_SPEED_HDR_DOL  CUS_CMU_CLK_27MHZ
+
+////////////////////////////////////
+// I2C Info                       //
+////////////////////////////////////
+#define SENSOR_I2C_ADDR              0x34                //I2C slave address
+#define SENSOR_I2C_SPEED             300000              //200000 //300000 //240000                  //I2C speed, 60000~320000
+//#define SENSOR_I2C_CHANNEL           1                 //I2C Channel
+//#define SENSOR_I2C_PAD_MODE          2                 //Pad/Mode Number
+#define SENSOR_I2C_LEGACY            I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT               I2C_FMT_A16D8       //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+////////////////////////////////////
+// Sensor Signal                  //
+////////////////////////////////////
+#define SENSOR_PWDN_POL              CUS_CLK_POL_NEG     // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL               CUS_CLK_POL_NEG     // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+                                                         // VSYNC/HSYNC POL can be found in data sheet timing diagram,
+                                                         // Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+#define SENSOR_VSYNC_POL             CUS_CLK_POL_NEG     // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL             CUS_CLK_POL_NEG     // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL              CUS_CLK_POL_NEG     // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+////////////////////////////////////
+// Sensor ID                      //
+////////////////////////////////////
+//define SENSOR_ID
+
+#undef SENSOR_NAME
+#define SENSOR_NAME     IMX335
+
+////////////////////////////////////
+// Image Info                     //
+////////////////////////////////////
+static struct {     // LINEAR
+    // Modify it based on number of support resolution
+    enum {LINEAR_RES_1 = 0, LINEAR_RES_2, LINEAR_RES_END}mode;
+    // Sensor Output Image info
+    struct _senout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _sensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _senstr{
+        const char* strResDesc;
+    }senstr;
+}imx335_mipi_linear[] = {
+    {LINEAR_RES_1, {2592, 1944, 3, 25}, {0, 0, 2592, 1944}, {"2592x1944@25fps"}},
+    {LINEAR_RES_2, {2592, 1944, 3, 30}, {0, 0, 2592, 1944}, {"2592x1944@30fps"}}, // Modify it
+};
+
+static struct {     // HDR
+    // Modify it based on number of support resolution
+    enum {HDR_RES_1 = 0, HDR_RES_2, HDR_RES_3, HDR_RES_END}mode;
+    // Sensor Output Image info
+    struct _hsenout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _hsensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _hsenstr{
+        const char* strResDesc;
+    }senstr;
+}imx335_mipi_hdr[] = {
+    {HDR_RES_1, {2592, 1944, 3, 25}, {4, 0, 2592, 1944}, {"2592x1944@25fps_HDR"}}, // Modify it
+    {HDR_RES_2, {2592, 1944, 3, 20}, {4, 0, 2592, 1944}, {"2592x1944@20fps_HDR"}}, // Modify it
+    {HDR_RES_3, {2592, 1944, 3, 30}, {4, 0, 2592, 1944}, {"2592x1944@30fps_HDR"}}, // Modify it
+};
+
+#define IMX335_HDR_BRL                              2228
+
+u32 Preview_line_period;
+u32 vts_30fps;
+u32 Preview_MAX_FPS;
+u32 Preview_line_period_HDR_DOL;
+u32 vts_30fps_HDR_DOL;
+
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+//#define vc0_hs_mode 3   //0: packet header edge  1: line end edge 2: line start edge 3: packet footer edge
+//#define long_packet_type_enable 0x00 //UD1~UD8 (user define)
+////////////////////////////////////
+// AE Info                        //
+////////////////////////////////////
+#define SENSOR_MAX_GAIN                             (1412 * 1024)        // max sensor again, a-gain * conversion-gain*d-gain
+#define SENSOR_MIN_GAIN                             (1 * 1024)
+#define SENSOR_GAIN_DELAY_FRAME_COUNT               (2)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT            (2)
+#define SENSOR_GAIN_DELAY_FRAME_COUNT_HDR_DOL       (1)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL    (2)
+
+////////////////////////////////////
+// Mirror-Flip Info               //
+////////////////////////////////////
+#define REG_MIRROR                                  0x304E
+#define REG_FLIP                                    0x304F
+#define SENSOR_NOR                                  0x0
+#define MIRROR_EN                                   0x1 << (0)
+#define FLIP_EN                                     0x1 << (0)
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+
+//static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+//static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+static int pCus_SetAEUSecsHDR_DOL_SEF1(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us);
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 expo_lines;
+        u32 expo_lef_us;
+        u32 expo_sef_us;
+    } expo;
+    u32 max_rhs1;
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool dirty;
+    bool orien_dirty;
+    I2C_ARRAY tVts_reg[3];
+    I2C_ARRAY tGain_reg[2];
+    I2C_ARRAY tExpo_reg[3];
+    I2C_ARRAY tExpo_shr_dol1_reg[3];
+    I2C_ARRAY tExpo_rhs1_reg[3];
+    I2C_ARRAY tGain_hdr_dol_lef_reg[2];
+    I2C_ARRAY tGain_hdr_dol_sef_reg[2];
+} imx335_params;
+// set sensor ID address and data,
+
+const static I2C_ARRAY Sensor_id_table[] =
+{
+    {0x3003, 0x00},      // {address of ID, ID },
+    {0x3033, 0x00}
+};
+
+const static I2C_ARRAY Sensor_init_table_2lane_5m25fps[] =
+{
+    /*"IMX335LQN All-pixel scan CSI-2_2lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 25fps"*/
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},  //BCWAIT_TIME
+    {0x300D,0x2E},  //CPWAIT_TIME
+    {0x3030,0x56},  //VMAX //101Dh: 4125 //1518h: 5400
+    {0x3031,0x13},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+    {0x3050,0x00},  //ADBIT
+    {0x314C,0xB0},  //INCKSEL1
+    {0x315A,0x02},  //INCKSEL2
+    {0x3168,0x8F},  //INCKSEL3
+    {0x316A,0x7E},  //INCKSEL4
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},  //XH&VSOUTSEL
+    {0x31A1,0x00},  //XVS/XHS pin setting
+    {0x31A4,0x00},  //PULSE1_UP
+    {0x31A5,0x00},  //PULSE1_UP
+    {0x31A6,0x00},  //PULSE1_UP
+    {0x31A8,0x00},  //PULSE1EN/PULSE1_POL
+    {0x31AC,0x00},  //PULSE1_DN
+    {0x31AD,0x00},  //PULSE1_DN
+    {0x31AE,0x00},  //PULSE1_DN
+    {0x31D4,0x00},  //XVSLNG
+    {0x31D5,0x00},  //XHSLNG
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x341D,0x01},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3A01,0x01},  //LANEMODE 0x03:4Lane  0x01:2Lane
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_2lane_5m30fps[] =
+{
+    /*"IMX335LQN All-pixel scan CSI-2_2lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 30fps"*/
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},  //BCWAIT_TIME
+    {0x300D,0x2E},  //CPWAIT_TIME
+    {0x3030,0x1D},  //VMAX //1194 :4500 //101D: 4125
+    {0x3031,0x10},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+    {0x3050,0x00},  //ADBIT
+    {0x314C,0xB0},  //INCKSEL1
+    {0x315A,0x02},  //INCKSEL2
+    {0x3168,0x8F},  //INCKSEL3
+    {0x316A,0x7E},  //INCKSEL4
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},  //XH&VSOUTSEL
+    {0x31A1,0x00},  //XVS/XHS pin setting
+    {0x31A4,0x00},  //PULSE1_UP
+    {0x31A5,0x00},  //PULSE1_UP
+    {0x31A6,0x00},  //PULSE1_UP
+    {0x31A8,0x00},  //PULSE1EN/PULSE1_POL
+    {0x31AC,0x00},  //PULSE1_DN
+    {0x31AD,0x00},  //PULSE1_DN
+    {0x31AE,0x00},  //PULSE1_DN
+    {0x31D4,0x00},  //XVSLNG
+    {0x31D5,0x00},  //XHSLNG
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x341D,0x01},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3A01,0x01},  //LANEMODE 0x03:4Lane  0x01:2Lane
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_4lane_5m25fps[] =
+{
+/* "IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 25fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x56},  //VMAX //101Dh: 4125 //1518h: 5400
+    {0x3031,0x13},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xFF},  //0x47--12-bit   0xff--10bit
+    {0x341d,0x01},  //0x00--12-bit   0x01--10bit
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    //{0x3A18,0x7F},  //TCLKPOST
+    //{0x3A19,0x00},  //TCLKPOST
+    //{0x3A1A,0x37},  //TCLKPREPARE
+    //{0x3A1B,0x00},  //TCLKPREPARE
+    //{0x3A1C,0x37},  //TCLKTRAIL
+    //{0x3A1D,0x00},  //TCLKTRAIL
+    //{0x3A1E,0xF7},  //TCLKZERO
+    //{0x3A1F,0x00},  //TCLKZERO
+    //{0x3A20,0x3F},  //THSPREPARE
+    //{0x3A21,0x00},  //THSPREPARE
+    //{0x3A22,0x6F},  //THSZERO
+    //{0x3A23,0x00},  //THSZERO
+    //{0x3A24,0x3F},  //THSTRAIL
+    //{0x3A25,0x00},  //THSTRAIL
+    //{0x3A26,0x5F},  //THSEXIT
+    //{0x3A27,0x00},  //THSEXIT
+    //{0x3A28,0x2F},  //TLPX
+    //{0x3A29,0x00},  //TLPX
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_4lane_5m30fps[] =
+{
+/* "IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 30fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x1D},  //VMAX //1194 :4500 //101D: 4125
+    {0x3031,0x10},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xFF},  //0x47--12-bit   0xff--10bit
+    {0x341d,0x01},  //0x00--12-bit   0x01--10bit
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    //{0x3A18,0x7F},  //TCLKPOST
+    //{0x3A19,0x00},  //TCLKPOST
+    //{0x3A1A,0x37},  //TCLKPREPARE
+    //{0x3A1B,0x00},  //TCLKPREPARE
+    //{0x3A1C,0x37},  //TCLKTRAIL
+    //{0x3A1D,0x00},  //TCLKTRAIL
+    //{0x3A1E,0xF7},  //TCLKZERO
+    //{0x3A1F,0x00},  //TCLKZERO
+    //{0x3A20,0x3F},  //THSPREPARE
+    //{0x3A21,0x00},  //THSPREPARE
+    //{0x3A22,0x6F},  //THSZERO
+    //{0x3A23,0x00},  //THSZERO
+    //{0x3A24,0x3F},  //THSTRAIL
+    //{0x3A25,0x00},  //THSTRAIL
+    //{0x3A26,0x5F},  //THSEXIT
+    //{0x3A27,0x00},  //THSEXIT
+    //{0x3A28,0x2F},  //TLPX
+    //{0x3A29,0x00},  //TLPX
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_4lane5m25fps[] =
+{
+#if 1
+/*"IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode DOL HDR 2frameLI 25fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x9A}, //VMAX 1518: 5400 //4500 1194 //4250 109A
+    {0x3031,0x10},
+    {0x3032,0x00},
+    {0x3034,0x5D}, //HMAX 113: 275  14A          //15Dh 349
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304A,0x04},
+    {0x304B,0x03},
+    {0x304C,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07}, //Y_OUT_SIZE[7:0]
+    {0x3057,0x08}, //Y_OUT_SIZE[12:8]
+    {0x3058,0x88},
+    {0x3059,0x1D},
+    {0x305A,0x00},
+    {0x305C,0x12},
+    {0x305D,0x00},
+    {0x305E,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306A,0x00},
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},
+    {0x319F,0x00}, //0x2
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x01},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3300,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},//0x47--12-bit   0xff--10bit
+    {0x341D,0x01},//
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    //{0x37b0,0x36},
+    //{0x3a01,0x03},
+    //{0x3a04,0x90},
+    //{0x3a05,0x12},
+    //{0x3a18,0x8f},
+    //{0x3a19,0x00},
+    //{0x3a1a,0x4f},
+    //{0x3a1b,0x00},
+    //{0x3a1c,0x47},
+    //{0x3a1d,0x00},
+    //{0x3a1e,0x37},
+    //{0x3a1f,0x01},
+    //{0x3a20,0x4f},
+    //{0x3a21,0x00},
+    //{0x3a22,0x87},
+    //{0x3a23,0x00},
+    //{0x3a24,0x4f},
+    //{0x3a25,0x00},
+    //{0x3a26,0x7f},
+    //{0x3a27,0x00},
+    //{0x3a28,0x3f},
+    //{0x3a29,0x00},
+    {0x3000,0x00},
+    {0x3002,0x00},
+#else //Ori_24Mhz
+    {0x3000,0x01},
+    {0x3001,0x00},
+    {0x3002,0x01},
+    {0x3003,0x00},
+
+    {0x300c,0x3b},
+    {0x300d,0x2a},
+    {0x3018,0x00},
+    {0x302c,0x30},
+    {0x302d,0x00},
+    {0x302e,0x38},
+    {0x302f,0x0a},
+
+    {0x3030,0x9A}, //VMAX 1518: 5400 //4500 1194 //4250 109A
+    {0x3031,0x10},
+    {0x3032,0x00},
+    {0x3034,0x5D}, //HMAX 113: 275  14A          //15Dh 349
+    {0x3035,0x01},
+
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304a,0x04},
+    {0x304b,0x03},
+    {0x304c,0x00},
+    {0x304e,0x00},
+    {0x304f,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07},
+    {0x3057,0x08},
+    {0x3058,0x88},
+    {0x3059,0x1d},
+    {0x305a,0x00},
+    {0x305c,0x12},
+    {0x305d,0x00},
+    {0x305e,0x00},
+    {0x3060,0xe8},
+    {0x3061,0x00},
+    {0x3062,0x00},
+    {0x3064,0x09},
+    {0x3065,0x00},
+    {0x3066,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306a,0x00},
+    {0x306c,0x68},
+    {0x306d,0x06},
+    {0x306e,0x00},
+    {0x3072,0x28},
+    {0x3073,0x00},
+    {0x3074,0xb0},
+    {0x3075,0x00},
+    {0x3076,0x58},
+    {0x3077,0x0f},
+
+    {0x3078,0x01},
+    {0x3079,0x02},
+    {0x307a,0xff},
+    {0x307b,0x02},
+    {0x307c,0x00},
+    {0x307d,0x00},
+    {0x307e,0x00},
+    {0x307f,0x00},
+    {0x3080,0x01},
+    {0x3081,0x02},
+    {0x3082,0xff},
+    {0x3083,0x02},
+    {0x3084,0x00},
+    {0x3085,0x00},
+    {0x3086,0x00},
+    {0x3087,0x00},
+
+    {0x30a4,0x33},
+    {0x30a8,0x10},
+    {0x30a9,0x04},
+    {0x30ac,0x00},
+    {0x30ad,0x00},
+    {0x30b0,0x10},
+    {0x30b1,0x08},
+    {0x30b4,0x00},
+    {0x30b5,0x00},
+    {0x30b6,0x00},
+    {0x30b7,0x00},
+
+    {0x30c6,0x00},
+    {0x30c7,0x00},
+    {0x30ce,0x00},
+    {0x30cf,0x00},
+    {0x30d8,0x4c},
+    {0x30d9,0x10},
+    {0x30e8,0x00},
+    {0x30e9,0x00},
+    {0x30ea,0x00},
+    {0x30eb,0x00},
+    {0x30ec,0x00},
+    {0x30ed,0x00},
+    {0x30ee,0x00},
+    {0x30ef,0x00},
+    {0x3112,0x08},
+    {0x3113,0x00},
+    {0x3116,0x08},
+    {0x3117,0x00},
+    {0x314c,0xc6},
+    {0x314d,0x00},
+    {0x315a,0x02},
+    {0x3167,0x01},
+    {0x3168,0xa0},
+    {0x316a,0x7e},
+    {0x3199,0x00},
+    {0x319d,0x00},
+    {0x319e,0x01},
+    {0x319f,0x00},
+    {0x31a0,0x2a},
+    {0x31a1,0x00},
+    {0x31a4,0x00},
+    {0x31a5,0x00},
+    {0x31a6,0x00},
+    {0x31a8,0x00},
+    {0x31ac,0x00},
+    {0x31ad,0x00},
+    {0x31ae,0x00},
+    {0x31d4,0x00},
+    {0x31d5,0x00},
+    {0x31d7,0x01},
+    {0x31e4,0x01},
+    {0x31e8,0x00},
+    {0x31f3,0x01},
+    {0x3200,0x01},
+    {0x3288,0x21},
+    {0x328a,0x02},
+    {0x3300,0x00},
+    {0x3302,0x32},
+    {0x3303,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xff},//0x47--12-bit   0xff--10bit
+    {0x341d,0x01},//
+    {0x3648,0x01},
+    {0x364a,0x04},
+    {0x364c,0x04},
+    {0x3678,0x01},
+    {0x367c,0x31},
+    {0x367e,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371c,0x3d},
+    {0x371d,0x3f},
+    {0x372c,0x00},
+    {0x372d,0x00},
+    {0x372e,0x46},
+    {0x372f,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xfe},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1b},
+    {0x3769,0x1b},
+    {0x376a,0x1b},
+    {0x376b,0x1b},
+    {0x376c,0x1a},
+    {0x376d,0x17},
+    {0x376e,0x0f},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377a,0x89},
+    {0x377b,0x00},
+    {0x377c,0x08},
+    {0x377d,0x01},
+    {0x377e,0x23},
+    {0x377f,0x02},
+    {0x3780,0xd9},
+    {0x3781,0x03},
+    {0x3782,0xf5},
+    {0x3783,0x06},
+    {0x3784,0xa5},
+    {0x3788,0x0f},
+    {0x378a,0xd9},
+    {0x378b,0x03},
+    {0x378c,0xeb},
+    {0x378d,0x05},
+    {0x378e,0x87},
+    {0x378f,0x06},
+    {0x3790,0xf5},
+    {0x3792,0x43},
+    {0x3794,0x7a},
+    {0x3796,0xa1},
+    {0x37b0,0x36},
+    {0x3a01,0x03},
+    {0x3a04,0x90},
+    {0x3a05,0x12},
+    {0x3a18,0x8f},
+    {0x3a19,0x00},
+    {0x3a1a,0x4f},
+    {0x3a1b,0x00},
+    {0x3a1c,0x47},
+    {0x3a1d,0x00},
+    {0x3a1e,0x37},
+    {0x3a1f,0x01},
+    {0x3a20,0x4f},
+    {0x3a21,0x00},
+    {0x3a22,0x87},
+    {0x3a23,0x00},
+    {0x3a24,0x4f},
+    {0x3a25,0x00},
+    {0x3a26,0x7f},
+    {0x3a27,0x00},
+    {0x3a28,0x3f},
+    {0x3a29,0x00},
+
+    {0x3000,0x00},
+    {0x3002,0x00},
+#endif
+};
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_4lane5m20fps[] =
+{
+#if 1
+/*"IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode DOL HDR 2frameLI 25fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0xC0}, //VMAX 1518: 5400 //4500 1194 //4250 109A
+    {0x3031,0x14},
+    {0x3032,0x00},
+    {0x3034,0x5D}, //HMAX 113: 275  14A          //15Dh 349
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304A,0x04},
+    {0x304B,0x03},
+    {0x304C,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07}, //Y_OUT_SIZE[7:0]
+    {0x3057,0x08}, //Y_OUT_SIZE[12:8]
+    {0x3058,0x88},
+    {0x3059,0x1D},
+    {0x305A,0x00},
+    {0x305C,0x12},
+    {0x305D,0x00},
+    {0x305E,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306A,0x00},
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},
+    {0x319F,0x00}, //0x2
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x01},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3300,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},//0x47--12-bit   0xff--10bit
+    {0x341D,0x01},//
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    //{0x37b0,0x36},
+    //{0x3a01,0x03},
+    //{0x3a04,0x90},
+    //{0x3a05,0x12},
+    //{0x3a18,0x8f},
+    //{0x3a19,0x00},
+    //{0x3a1a,0x4f},
+    //{0x3a1b,0x00},
+    //{0x3a1c,0x47},
+    //{0x3a1d,0x00},
+    //{0x3a1e,0x37},
+    //{0x3a1f,0x01},
+    //{0x3a20,0x4f},
+    //{0x3a21,0x00},
+    //{0x3a22,0x87},
+    //{0x3a23,0x00},
+    //{0x3a24,0x4f},
+    //{0x3a25,0x00},
+    //{0x3a26,0x7f},
+    //{0x3a27,0x00},
+    //{0x3a28,0x3f},
+    //{0x3a29,0x00},
+    {0x3000,0x00},
+    {0x3002,0x00},
+#else //Ori_24Mhz
+    {0x3000,0x01},
+    {0x3001,0x00},
+    {0x3002,0x01},
+    {0x3003,0x00},
+    {0x300c,0x3b},
+    {0x300d,0x2a},
+    {0x3018,0x00},
+    {0x302c,0x30},
+    {0x302d,0x00},
+    {0x302e,0x38},
+    {0x302f,0x0a},
+    {0x3030,0x5e},  //1A5Eh : 6750  // 16A8h : 5800
+    {0x3031,0x1a},
+    {0x3032,0x00},
+    {0x3033,0x00},
+    {0x3034,0x13},  //113h : 275   // 140h : 320
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304a,0x04},
+    {0x304b,0x03},
+    {0x304c,0x00},
+    {0x304e,0x00},
+    {0x304f,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07},
+    {0x3057,0x08},
+    {0x3058,0x14},
+    {0x3059,0x28},
+    {0x305a,0x00},
+    {0x305c,0x12},
+    {0x305d,0x00},
+    {0x305e,0x00},
+    {0x3060,0xe8},
+    {0x3061,0x00},
+    {0x3062,0x00},
+    {0x3064,0x09},
+    {0x3065,0x00},
+    {0x3066,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306a,0x00},
+    {0x306c,0x68},
+    {0x306d,0x06},
+    {0x306e,0x00},
+    {0x3072,0x28},
+    {0x3073,0x00},
+    {0x3074,0xb0},
+    {0x3075,0x00},
+    {0x3076,0x58},
+    {0x3077,0x0f},
+    {0x3078,0x01},
+    {0x3079,0x02},
+    {0x307a,0xff},
+    {0x307b,0x02},
+    {0x307c,0x00},
+    {0x307d,0x00},
+    {0x307e,0x00},
+    {0x307f,0x00},
+    {0x3080,0x01},
+    {0x3081,0x02},
+    {0x3082,0xff},
+    {0x3083,0x02},
+    {0x3084,0x00},
+    {0x3085,0x00},
+    {0x3086,0x00},
+    {0x3087,0x00},
+    {0x30a4,0x33},
+    {0x30a8,0x10},
+    {0x30a9,0x04},
+    {0x30ac,0x00},
+    {0x30ad,0x00},
+    {0x30b0,0x10},
+    {0x30b1,0x08},
+    {0x30b4,0x00},
+    {0x30b5,0x00},
+    {0x30b6,0x00},
+    {0x30b7,0x00},
+
+    {0x30c6,0x00},
+    {0x30c7,0x00},
+    {0x30ce,0x00},
+    {0x30cf,0x00},
+    {0x30d8,0x4c},
+    {0x30d9,0x10},
+    {0x30e8,0x00},
+    {0x30e9,0x00},
+    {0x30ea,0x00},
+    {0x30eb,0x00},
+    {0x30ec,0x00},
+    {0x30ed,0x00},
+    {0x30ee,0x00},
+    {0x30ef,0x00},
+    {0x3112,0x08},
+    {0x3113,0x00},
+    {0x3116,0x08},
+    {0x3117,0x00},
+    {0x314c,0xc6},
+    {0x314d,0x00},
+    {0x315a,0x02},
+    {0x3167,0x01},
+    {0x3168,0xa0},
+    {0x316a,0x7e},
+    {0x3199,0x00},
+    {0x319d,0x00},
+    {0x319e,0x01},
+    {0x319f,0x00},
+    {0x31a0,0x2a},
+    {0x31a1,0x00},
+    {0x31a4,0x00},
+    {0x31a5,0x00},
+    {0x31a6,0x00},
+    {0x31a8,0x00},
+    {0x31ac,0x00},
+    {0x31ad,0x00},
+    {0x31ae,0x00},
+    {0x31d4,0x00},
+    {0x31d5,0x00},
+    {0x31d7,0x01},
+    {0x31e4,0x01},
+    {0x31e8,0x00},
+    {0x31f3,0x01},
+    {0x3200,0x01},
+    {0x3288,0x21},
+    {0x328a,0x02},
+    {0x3300,0x00},
+    {0x3302,0x32},
+    {0x3303,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xff},//0x47--12-bit   0xff--10bit
+    {0x341d,0x01},//
+    {0x3648,0x01},
+    {0x364a,0x04},
+    {0x364c,0x04},
+    {0x3678,0x01},
+    {0x367c,0x31},
+    {0x367e,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371c,0x3d},
+    {0x371d,0x3f},
+    {0x372c,0x00},
+    {0x372d,0x00},
+    {0x372e,0x46},
+    {0x372f,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xfe},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1b},
+    {0x3769,0x1b},
+    {0x376a,0x1b},
+    {0x376b,0x1b},
+    {0x376c,0x1a},
+    {0x376d,0x17},
+    {0x376e,0x0f},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377a,0x89},
+    {0x377b,0x00},
+    {0x377c,0x08},
+    {0x377d,0x01},
+    {0x377e,0x23},
+    {0x377f,0x02},
+    {0x3780,0xd9},
+    {0x3781,0x03},
+    {0x3782,0xf5},
+    {0x3783,0x06},
+    {0x3784,0xa5},
+    {0x3788,0x0f},
+    {0x378a,0xd9},
+    {0x378b,0x03},
+    {0x378c,0xeb},
+    {0x378d,0x05},
+    {0x378e,0x87},
+    {0x378f,0x06},
+    {0x3790,0xf5},
+    {0x3792,0x43},
+    {0x3794,0x7a},
+    {0x3796,0xa1},
+    {0x37b0,0x36},
+    {0x3a01,0x03},
+    {0x3a04,0x90},
+    {0x3a05,0x12},
+    {0x3a18,0x8f},
+    {0x3a19,0x00},
+    {0x3a1a,0x4f},
+    {0x3a1b,0x00},
+    {0x3a1c,0x47},
+    {0x3a1d,0x00},
+    {0x3a1e,0x37},
+    {0x3a1f,0x01},
+    {0x3a20,0x4f},
+    {0x3a21,0x00},
+    {0x3a22,0x87},
+    {0x3a23,0x00},
+    {0x3a24,0x4f},
+    {0x3a25,0x00},
+    {0x3a26,0x7f},
+    {0x3a27,0x00},
+    {0x3a28,0x3f},
+    {0x3a29,0x00},
+
+    {0x3000,0x00},
+    {0x3002,0x00},
+#endif
+};
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_4lane5m30fps[] =
+{
+/*"IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode DOL HDR 2frameLI 30fps"*/
+#if 1
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x00},  //4096 1000h
+    {0x3031,0x10},
+    {0x3032,0x00},
+    {0x3034,0x2C},  //HMAX 300 : 12Ch
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304A,0x04},
+    {0x304B,0x03},
+    {0x304C,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07}, //Y_OUT_SIZE[7:0]
+    {0x3057,0x08}, //Y_OUT_SIZE[12:8]
+    {0x3058,0x1C},
+    {0x3059,0x22},
+    {0x305A,0x00},
+    {0x305C,0x12},
+    {0x305D,0x00},
+    {0x305E,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306A,0x00},
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},
+    {0x319F,0x00}, //0x2
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x01},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3300,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},//0x47--12-bit   0xff--10bit
+    {0x341D,0x01},//
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    //{0x37b0,0x36},
+    //{0x3a01,0x03},
+    //{0x3a04,0x90},
+    //{0x3a05,0x12},
+    //{0x3a18,0x8f},
+    //{0x3a19,0x00},
+    //{0x3a1a,0x4f},
+    //{0x3a1b,0x00},
+    //{0x3a1c,0x47},
+    //{0x3a1d,0x00},
+    //{0x3a1e,0x37},
+    //{0x3a1f,0x01},
+    //{0x3a20,0x4f},
+    //{0x3a21,0x00},
+    //{0x3a22,0x87},
+    //{0x3a23,0x00},
+    //{0x3a24,0x4f},
+    //{0x3a25,0x00},
+    //{0x3a26,0x7f},
+    //{0x3a27,0x00},
+    //{0x3a28,0x3f},
+    //{0x3a29,0x00},
+    {0x3000,0x00},
+    {0x3002,0x00},
+#else
+    {0x3000,0x01},
+    {0x3001,0x00},
+    {0x3002,0x01},
+    {0x3003,0x00},
+
+    {0x300c,0x3b},
+    {0x300d,0x2a},
+    {0x3018,0x00},
+    {0x302c,0x30},
+    {0x302d,0x00},
+    {0x302e,0x38},
+    {0x302f,0x0a},
+
+    {0x3030,0x9A}, //VMAX
+    {0x3031,0x11},
+    {0x3032,0x00},
+    {0x3033,0x00},
+    {0x3034,0x13}, //HMAX
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304a,0x04},
+    {0x304b,0x03},
+    {0x304c,0x00},
+    {0x304e,0x00},
+    {0x304f,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07},
+    {0x3057,0x08},
+    {0x3058,0x9c},
+    {0x3059,0x18},
+    {0x305a,0x00},
+    {0x305c,0x12},
+    {0x305d,0x00},
+    {0x305e,0x00},
+    {0x3060,0xe8},
+    {0x3061,0x00},
+    {0x3062,0x00},
+    {0x3064,0x09},
+    {0x3065,0x00},
+    {0x3066,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306a,0x00},
+    {0x306c,0x68},
+    {0x306d,0x06},
+    {0x306e,0x00},
+    {0x3072,0x28},
+    {0x3073,0x00},
+    {0x3074,0xb0},
+    {0x3075,0x00},
+    {0x3076,0x58},
+    {0x3077,0x0f},
+
+    {0x3078,0x01},
+    {0x3079,0x02},
+    {0x307a,0xff},
+    {0x307b,0x02},
+    {0x307c,0x00},
+    {0x307d,0x00},
+    {0x307e,0x00},
+    {0x307f,0x00},
+    {0x3080,0x01},
+    {0x3081,0x02},
+    {0x3082,0xff},
+    {0x3083,0x02},
+    {0x3084,0x00},
+    {0x3085,0x00},
+    {0x3086,0x00},
+    {0x3087,0x00},
+
+    {0x30a4,0x33},
+    {0x30a8,0x10},
+    {0x30a9,0x04},
+    {0x30ac,0x00},
+    {0x30ad,0x00},
+    {0x30b0,0x10},
+    {0x30b1,0x08},
+    {0x30b4,0x00},
+    {0x30b5,0x00},
+    {0x30b6,0x00},
+    {0x30b7,0x00},
+
+    {0x30c6,0x00},
+    {0x30c7,0x00},
+    {0x30ce,0x00},
+    {0x30cf,0x00},
+    {0x30d8,0x4c},
+    {0x30d9,0x10},
+    {0x30e8,0x00},
+    {0x30e9,0x00},
+    {0x30ea,0x00},
+    {0x30eb,0x00},
+    {0x30ec,0x00},
+    {0x30ed,0x00},
+    {0x30ee,0x00},
+    {0x30ef,0x00},
+    {0x3112,0x08},
+    {0x3113,0x00},
+    {0x3116,0x08},
+    {0x3117,0x00},
+    {0x314c,0xc6},
+    {0x314d,0x00},
+    {0x315a,0x02},
+    {0x3167,0x01},
+    {0x3168,0xa0},
+    {0x316a,0x7e},
+    {0x3199,0x00},
+    {0x319d,0x00},
+    {0x319e,0x01},
+    {0x319f,0x02},
+    {0x31a0,0x2a},
+    {0x31a1,0x00},
+    {0x31a4,0x00},
+    {0x31a5,0x00},
+    {0x31a6,0x00},
+    {0x31a8,0x00},
+    {0x31ac,0x00},
+    {0x31ad,0x00},
+    {0x31ae,0x00},
+    {0x31d4,0x00},
+    {0x31d5,0x00},
+    {0x31d7,0x01},
+    {0x31e4,0x01},
+    {0x31e8,0x00},
+    {0x31f3,0x01},
+    {0x3200,0x01},
+    {0x3288,0x21},
+    {0x328a,0x02},
+    {0x3300,0x00},
+    {0x3302,0x32},
+    {0x3303,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xff},//0x47--12-bit   0xff--10bit
+    {0x341d,0x01},//
+    {0x3648,0x01},
+    {0x364a,0x04},
+    {0x364c,0x04},
+    {0x3678,0x01},
+    {0x367c,0x31},
+    {0x367e,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371c,0x3d},
+    {0x371d,0x3f},
+    {0x372c,0x00},
+    {0x372d,0x00},
+    {0x372e,0x46},
+    {0x372f,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xfe},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1b},
+    {0x3769,0x1b},
+    {0x376a,0x1b},
+    {0x376b,0x1b},
+    {0x376c,0x1a},
+    {0x376d,0x17},
+    {0x376e,0x0f},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377a,0x89},
+    {0x377b,0x00},
+    {0x377c,0x08},
+    {0x377d,0x01},
+    {0x377e,0x23},
+    {0x377f,0x02},
+    {0x3780,0xd9},
+    {0x3781,0x03},
+    {0x3782,0xf5},
+    {0x3783,0x06},
+    {0x3784,0xa5},
+    {0x3788,0x0f},
+    {0x378a,0xd9},
+    {0x378b,0x03},
+    {0x378c,0xeb},
+    {0x378d,0x05},
+    {0x378e,0x87},
+    {0x378f,0x06},
+    {0x3790,0xf5},
+    {0x3792,0x43},
+    {0x3794,0x7a},
+    {0x3796,0xa1},
+    {0x37b0,0x36},
+    {0x3a01,0x03},
+    {0x3a04,0x90},
+    {0x3a05,0x12},
+    {0x3a18,0x8f},
+    {0x3a19,0x00},
+    {0x3a1a,0x4f},
+    {0x3a1b,0x00},
+    {0x3a1c,0x47},
+    {0x3a1d,0x00},
+    {0x3a1e,0x37},
+    {0x3a1f,0x01},
+    {0x3a20,0x4f},
+    {0x3a21,0x00},
+    {0x3a22,0x87},
+    {0x3a23,0x00},
+    {0x3a24,0x4f},
+    {0x3a25,0x00},
+    {0x3a26,0x7f},
+    {0x3a27,0x00},
+    {0x3a28,0x3f},
+    {0x3a29,0x00},
+
+    {0x3000,0x00},
+    {0x3002,0x00},
+#endif
+};
+
+static I2C_ARRAY PatternTbl[] = {
+    {0x308c,0x20}, //colorbar pattern , bit 0 to enable
+};
+
+const static I2C_ARRAY gain_HDR_DOL_LEF_reg[] =
+{
+    {0x30E8, 0x00},// bit0-7 low
+    {0x30E9, 0x00},// bit0-2(8-10)
+};
+
+const static I2C_ARRAY gain_HDR_DOL_SEF1_reg[] =
+{
+    {0x30EA, 0x00},// bit0-7 low
+    {0x30EB, 0x00},// bit0-2(8-10)
+};
+
+const static I2C_ARRAY expo_shr_dol1_reg[] =
+{ //SEL
+   {0x305e, 0x00},  // bit0-3(16-18)
+   {0x305d, 0x00},  // bit0-7(8-15)
+   {0x305c, 0x12},  // bit0-7
+};
+
+const I2C_ARRAY expo_rhs1_reg[] =
+{ //SEL
+   {0x306a, 0x00},  // bit0-3(16-18)
+   {0x3069, 0x00},  // bit0-7(8-15)
+   {0x3068, 0xCE},  // bit0-7
+};
+
+const static I2C_ARRAY mirr_flip_table[] =
+{
+    {0x304e, 0x00},     //M0F0
+    {0x304f, 0x00},     //M0F0
+    {0x3081, 0x02},
+    {0x3083, 0x02},
+    {0x30b6, 0x00},
+    {0x30b7, 0x00},
+    {0x3016, 0x08},
+
+    {0x304e, 0x01},     //M1F0
+    {0x304f, 0x00},     //M1F0
+    {0x3081, 0x02},
+    {0x3083, 0x02},
+    {0x30b6, 0x00},
+    {0x30b7, 0x00},
+    {0x3016, 0x08},
+
+    {0x304e, 0x00},     //M0F1
+    {0x304f, 0x01},     //M0F1
+    {0x3081, 0xfe},
+    {0x3083, 0xfe},
+    {0x30b6, 0xfa},
+    {0x30b7, 0x01},
+    {0x3016, 0x02},
+
+    {0x304e, 0x01},     //M1F1
+    {0x304f, 0x01},     //M1F1
+    {0x3081, 0xfe},
+    {0x3083, 0xfe},
+    {0x30b6, 0xfa},
+    {0x30b7, 0x01},
+    {0x3016, 0x02},
+};
+
+const static I2C_ARRAY gain_reg[] = {
+    {0x30E8, 0x00},// bit0-7 low
+    {0x30E9, 0x00},// bit0-2(8-10)
+};
+
+//static int g_sensor_ae_min_gain = 1024;
+static CUS_GAIN_GAP_ARRAY gain_gap_compensate[16] = {  //compensate  gain gap
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0}
+};
+
+const static I2C_ARRAY expo_reg[] = {
+   {0x305a, 0x00},  // bit0-3(16-18)
+   {0x3059, 0x00},  // bit0-7(8-15)
+   {0x3058, 0x09},  // bit0-7
+};
+
+const static I2C_ARRAY vts_reg[] = {
+   {0x3032, 0x00},  // bit0-3(16-18)
+   {0x3031, 0x11},  // bit0-7(8-15)
+   {0x3030, 0x94},  // bit0-7
+};
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@@                                               //
+//           @@                                                //
+//          @@                                                 //
+//          @@@                                                //
+//       @   @@                                                //
+//        @@@@                                                 //
+//                                                             //
+//      Step 3 --  complete camera features                    //
+//                                                             //
+//  camera set EV, MWB, orientation, contrast, sharpness       //
+//   , saturation, and Denoise can work correctly.             //
+//                                                             //
+/////////////////////////////////////////////////////////////////
+#if 0
+static CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////// function definition ///////////////////
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+#if 0
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+#endif
+    return SUCCESS;
+}
+#endif
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+/*******I5/I6 Support MCLK List*******
+ *    CUS_CMU_CLK_27MHZ,
+ *    CUS_CMU_CLK_21P6MHZ,
+ *    CUS_CMU_CLK_12MHZ,
+ *    CUS_CMU_CLK_5P4MHZ,
+ *    CUS_CMU_CLK_36MHZ,
+ *    CUS_CMU_CLK_54MHZ,
+ *    CUS_CMU_CLK_43P2MHZ,
+ *    CUS_CMU_CLK_61P7MHZ,
+ *    CUS_CMU_CLK_72MHZ,
+ *    CUS_CMU_CLK_48MHZ,
+ *    CUS_CMU_CLK_24MHZ,
+ *    CUS_CMU_CLK_37P125MHZ,
+ ******End of Support MCLK List*******/
+ #if 0
+static CUS_MCLK_FREQ UseParaMclk(const char *mclk)
+{
+    if (strcmp(mclk, "27M") == 0) {
+        return CUS_CMU_CLK_27MHZ;
+    } else if (strcmp(mclk, "12M") == 0) {
+        return CUS_CMU_CLK_12MHZ;
+    } else if (strcmp(mclk, "36M") == 0) {
+        return CUS_CMU_CLK_36MHZ;
+    } else if (strcmp(mclk, "48M") == 0) {
+        return CUS_CMU_CLK_48MHZ;
+    } else if (strcmp(mclk, "54M") == 0) {
+        return CUS_CMU_CLK_54MHZ;
+    } else if (strcmp(mclk, "24M") == 0) {
+        return CUS_CMU_CLK_24MHZ;
+    } else if (strcmp(mclk, "37.125M") == 0) {
+        return CUS_CMU_CLK_37P125MHZ;
+    }
+    return Preview_MCLK_SPEED;
+}
+#endif
+
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    //Sensor power on sequence
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 1);
+    }
+
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    //Sensor board PWDN Enable, 1.8V & 2.9V need 30ms then Pull High
+    SENSOR_MSLEEP(31);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_UDELAY(1);
+    sensor_if->MCLK(idx, 1, handle->mclk);
+    SENSOR_DMSG("Sensor Power On finished\n");
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 0);
+    }
+    handle->orient = SENSOR_ORIT;
+
+    return SUCCESS;
+}
+
+/////////////////// Check Sensor Product ID /////////////////////////
+#if 0
+static int pCus_CheckSensorProductID(ms_cus_sensor *handle)
+{
+    u16 sen_id_msb, sen_id_lsb, sen_data;
+
+    /* Read Product ID */
+    SensorReg_Read(0x3f12, &sen_id_lsb);
+    SensorReg_Read(0x3f13, &sen_id_msb);//CHIP_ID_r3F13
+    sen_data = ((sen_id_lsb & 0x0F) << 8) | (sen_id_lsb & 0xF0) | (sen_id_msb & 0x0F);
+#if 0
+    if (sen_data != CHIP_ID) {
+        printk("[***ERROR***]Check Product ID Fail: 0x%x\n", sen_data);
+        return FAIL;
+    }
+#endif
+    return SUCCESS;
+}
+#endif
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8) table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>2) return FAIL;
+
+      if(/* SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == */SUCCESS) //read sensor ID from I2C
+          break;
+      else
+          SENSOR_MSLEEP(1);
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+      if( id_from_sensor[i].data != Sensor_id_table[i].data )
+        return FAIL;
+      *id = id_from_sensor[i].data;
+    }
+
+    SENSOR_DMSG("[%s]IMX335 sensor ,Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    return SUCCESS;
+}
+
+static int imx335_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+    int i;
+    switch(mode)
+    {
+    case 1:
+        PatternTbl[0].data = 0x21; //enable
+        break;
+    case 0:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+    default:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+      }
+
+    for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+    {
+        if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+        {
+            //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+            return FAIL;
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi2lane_5m25fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_2lane_5m25fps);i++)
+    {
+        if(Sensor_init_table_2lane_5m25fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_2lane_5m25fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_2lane_5m25fps[i].reg,Sensor_init_table_2lane_5m25fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_2lane_5m25fps[i].reg, Sensor_init_table_2lane_5m25fps[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_2lane_5m25fps[i].reg, &sen_data );
+            if(Sensor_init_table_2lane_5m25fps[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_2lane_5m25fps[i].reg);
+                //printk("IMX335 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_2lane_5m25fps[i].reg, Sensor_init_table_2lane_5m25fps[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi2lane_5m30fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_2lane_5m30fps);i++)
+    {
+        if(Sensor_init_table_2lane_5m30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_2lane_5m30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_2lane_5m30fps[i].reg,Sensor_init_table_2lane_5m30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_2lane_5m30fps[i].reg, Sensor_init_table_2lane_5m30fps[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_2lane_5m30fps[i].reg, &sen_data );
+            if(Sensor_init_table_2lane_5m30fps[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_2lane_5m30fps[i].reg);
+                //printk("IMX335 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_2lane_5m30fps[i].reg, Sensor_init_table_2lane_5m30fps[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_5m30fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_5m30fps);i++)
+    {
+        if(Sensor_init_table_4lane_5m30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_5m30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_5m30fps[i].reg,Sensor_init_table_4lane_5m30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_5m30fps[i].reg, Sensor_init_table_4lane_5m30fps[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_4lane_5m30fps[i].reg, &sen_data );
+            if(Sensor_init_table_4lane_5m30fps[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_4lane_5m30fps[i].reg);
+                //printk("IMX335 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane_5m30fps[i].reg, Sensor_init_table_4lane_5m30fps[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_5m25fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_5m25fps);i++)
+    {
+        if(Sensor_init_table_4lane_5m25fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_5m25fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_5m25fps[i].reg,Sensor_init_table_4lane_5m25fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_5m25fps[i].reg, Sensor_init_table_4lane_5m25fps[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_4lane_5m25fps[i].reg, &sen_data );
+            if(Sensor_init_table_4lane_5m25fps[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_4lane_5m25fps[i].reg);
+                //printk("IMX335 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane_5m25fps[i].reg, Sensor_init_table_4lane_5m25fps[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane5m25fps_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane5m25fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane5m25fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg,Sensor_init_table_HDR_DOL_4lane5m25fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg, Sensor_init_table_HDR_DOL_4lane5m25fps[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg, &sen_data );
+            if(Sensor_init_table_HDR_DOL_4lane5m25fps[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg);
+                //printk("IMX335 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg, Sensor_init_table_HDR_DOL_4lane5m25fps[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane5m20fps_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane5m20fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane5m20fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg,Sensor_init_table_HDR_DOL_4lane5m20fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg, Sensor_init_table_HDR_DOL_4lane5m20fps[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg, &sen_data );
+            if(Sensor_init_table_HDR_DOL_4lane5m20fps[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg);
+                //printk("IMX335 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg, Sensor_init_table_HDR_DOL_4lane5m20fps[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane5m30fps_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane5m30fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane5m30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg,Sensor_init_table_HDR_DOL_4lane5m30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg, Sensor_init_table_HDR_DOL_4lane5m30fps[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg, &sen_data );
+            if(Sensor_init_table_HDR_DOL_4lane5m30fps[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg);
+                //printk("IMX335 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg, Sensor_init_table_HDR_DOL_4lane5m30fps[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            if(lane_num == 2){
+                handle->pCus_sensor_init = pCus_init_mipi2lane_5m25fps_linear;
+            }
+            else if (lane_num == 4){
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m25fps_linear;
+            }
+            else{
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m25fps_linear;
+            }
+            vts_30fps = 4950;
+            Preview_MAX_FPS = 25;
+            Preview_line_period  = 8080;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            if(lane_num == 2){
+                handle->pCus_sensor_init = pCus_init_mipi2lane_5m30fps_linear;
+            }
+            else if (lane_num == 4){
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m30fps_linear;
+            }
+            else{
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m30fps_linear;
+            }
+
+            vts_30fps  = 4125;
+            Preview_MAX_FPS = 30;
+            Preview_line_period = 8080;
+            break;
+        default:
+            break;
+    }
+    params->expo.vts = vts_30fps;
+    params->expo.fps = Preview_MAX_FPS;
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    //ISensorIfAPI *sensor_if = &handle->sensor_if_api;
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_mipi4lane5m25fps_HDR_DOL;
+            vts_30fps_HDR_DOL = 4250;
+            params->expo.vts = vts_30fps_HDR_DOL;
+            Preview_MAX_FPS = 25;
+            params->expo.fps=Preview_MAX_FPS;
+            Preview_line_period_HDR_DOL = 9411; //8889
+            params->max_rhs1 = 290;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            handle->pCus_sensor_init = pCus_init_mipi4lane5m20fps_HDR_DOL;
+            vts_30fps_HDR_DOL = 5312;
+            params->expo.vts = vts_30fps_HDR_DOL;
+            Preview_MAX_FPS = 20;
+            params->expo.fps=Preview_MAX_FPS;
+            Preview_line_period_HDR_DOL = 9411;
+            params->max_rhs1 = 290;
+            break;
+        case 2:
+            handle->video_res_supported.ulcur_res = 2;
+            handle->pCus_sensor_init = pCus_init_mipi4lane5m30fps_HDR_DOL;
+            vts_30fps_HDR_DOL = 4096;
+            params->expo.vts = vts_30fps_HDR_DOL;
+            Preview_MAX_FPS = 30;
+            params->expo.fps= Preview_MAX_FPS;
+            Preview_line_period_HDR_DOL = 8318;
+            params->max_rhs1 = 290;
+            break;
+        default:
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    short Horiz_Inv = 0;
+    short Verti_Inv = 0;
+    short Orien_Mode = 0;
+    SensorReg_Read(0x304e, &Horiz_Inv);
+    SensorReg_Read(0x304f, &Verti_Inv);
+    Horiz_Inv &= 0x01;
+    Verti_Inv &= 0X01;
+    Orien_Mode = Horiz_Inv |(Verti_Inv << 2);
+    switch(Orien_Mode)
+    {
+        case 0x00:
+            *orit = CUS_ORIT_M0F0;
+        break;
+        case 0x01:
+            *orit = CUS_ORIT_M1F0;
+        break;
+        case 0x02:
+            *orit = CUS_ORIT_M0F1;
+        break;
+        case 0x03:
+            *orit = CUS_ORIT_M1F1;
+        break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    handle->orient = orit;
+    params->orien_dirty = true;
+
+    return SUCCESS;
+}
+
+static int DoOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    int table_length = ARRAY_SIZE(mirr_flip_table);
+    int seg_length = table_length/4;
+    int i,j;
+
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            handle->orient = CUS_ORIT_M0F0;
+            for(i = 0, j = 0; i < seg_length; i++, j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                //SensorReg_Write(0x304e,0x00);
+                //SensorReg_Write(0x304f,0x00);
+            }
+            break;
+        case CUS_ORIT_M1F0:
+            for(i = seg_length, j = 0; i < seg_length*2; i++, j++){
+                handle->orient = CUS_ORIT_M1F0;
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                //SensorReg_Write(0x304e,0x01);
+                //SensorReg_Write(0x304f,0x00);
+            }
+            break;
+        case CUS_ORIT_M0F1:
+            for(i = seg_length * 2, j = 0; i < seg_length*3; i++, j++){
+                handle->orient = CUS_ORIT_M0F1;
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                //SensorReg_Write(0x304e,0x00);
+                //SensorReg_Write(0x304f,0x01);
+            }
+            break;
+        case CUS_ORIT_M1F1:
+            for(i = seg_length * 3, j = 0; i < seg_length*4; i++, j++){
+                handle->orient = CUS_ORIT_M1F1;
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                //SensorReg_Write(0x304e,0x01);
+                //SensorReg_Write(0x304e,0x01);
+            }
+            break;
+        default :
+            handle->orient = CUS_ORIT_M0F0;
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+    }else if((fps>=(min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts = (vts_30fps*(max_fps*1000) + (fps>>1))/fps;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=25;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > params->expo.vts -2){
+        vts = params->expo.expo_lines + 8;
+    }else{
+        vts = params->expo.vts;
+    }
+    params->expo.vts = vts;
+    pCus_SetAEUSecs(handle, params->expo.expo_lef_us);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_SEF1(ms_cus_sensor *handle)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_SEF1(ms_cus_sensor *handle, u32 fps)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts = (vts_30fps_HDR_DOL*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts = (vts_30fps_HDR_DOL*(max_fps*1000) + (fps>>1))/fps;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+      return FAIL;
+    }
+    params->dirty = true; //reg need to update = true;
+    pCus_SetAEUSecsHDR_DOL_SEF1(handle, params->expo.expo_sef_us);
+
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap)
+{
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1);
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+                params->dirty = false;
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_SEF1(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    //imx335_params *params = (imx335_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us)
+{
+    u32 lines = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    lines |= (u32)(params->tExpo_reg[0].data&0xff)<<16;
+    lines |= (u32)(params->tExpo_reg[1].data&0xff)<<8;
+    lines |= (u32)(params->tExpo_reg[2].data&0xff)<<0;
+
+    *us = (lines*Preview_line_period)/1000;
+    SENSOR_DMSG("[%s] sensor expo lines/us %u,%u us\n", __FUNCTION__, lines, *us);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, vts = 0,activeline = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    params->expo.expo_lef_us = us;
+
+    lines = (1000 * us) / Preview_line_period;
+    if(lines < 9) lines = 9;
+    params->expo.expo_lines = lines;
+
+    if (lines >params->expo.vts-1)
+        vts = lines +1;
+    else
+        vts = params->expo.vts;
+
+    SENSOR_DMSG("[%s] us %u, lines %u, vts %u\n", __FUNCTION__,
+                us,
+                lines,
+                params->expo.vts
+                );
+
+    activeline = vts - lines;
+    if(activeline < 9) activeline = 9;
+
+    params->tExpo_reg[0].data = (activeline>>16) & 0x000f;
+    params->tExpo_reg[1].data = (activeline>>8) & 0x00ff;
+    params->tExpo_reg[2].data = (activeline>>0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x000f;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF1(ms_cus_sensor *handle, u32 us)
+{
+    u32 qua_lines = 0, lines = 0, long_lines = 0,vts = 0, fsc = 0;
+    u32 rhs1 = 0, shs1 = 0, shs0 = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    params->expo.expo_sef_us = us;
+    qua_lines = (1000 * us) / Preview_line_period_HDR_DOL /4;
+    vts = params->expo.vts;
+    shs0 = (params->tExpo_reg[0].data << 16) | (params->tExpo_reg[1].data << 8) | (params->tExpo_reg[2].data << 0);
+    fsc = vts * 2;
+    long_lines = fsc - shs0;
+    params->expo.expo_lines = long_lines;
+
+    //params->max_rhs1 = 290;
+    rhs1 = params->max_rhs1;//(params->tExpo_rhs1_reg[0].data << 16) | (params->tExpo_rhs1_reg[1].data << 8) | (params->tExpo_rhs1_reg[2].data << 0);
+
+    if(qua_lines <= 1)
+        qua_lines = 1;
+    if((4*qua_lines) > (rhs1- 18))
+        qua_lines = (rhs1 - 18)/4;
+
+    lines = 4*qua_lines;
+    if((rhs1 - 18) <= lines){
+        shs1 = 18;
+    }
+    else if((rhs1 <= params->max_rhs1) && (rhs1 <= shs0 - 18)){
+        shs1 = rhs1 - lines;
+        if((shs1 < 18) || (shs1 > (rhs1 - 4))){ //Check boundary
+            //shs1 = 0;
+            //UartSendTrace("[SEF1 NG1]");
+        }
+    }
+    else{
+        //UartSendTrace("[SEF1 NG2]");
+    }
+
+    params->tExpo_shr_dol1_reg[0].data = (shs1 >> 16) & 0x000f;
+    params->tExpo_shr_dol1_reg[1].data = (shs1 >> 8) & 0x00ff;
+    params->tExpo_shr_dol1_reg[2].data = (shs1 >> 0) & 0x00ff;
+    params->tExpo_rhs1_reg[0].data = (rhs1 >> 16) & 0x000f;
+    params->tExpo_rhs1_reg[1].data = (rhs1 >> 8) & 0x00ff;
+    params->tExpo_rhs1_reg[2].data = (rhs1 >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain)
+{
+    //int rc = SensorRegArrayR((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+    unsigned short temp_gain;
+  //  *gain=params->expo.final_gain;
+    temp_gain=gain_reg[0].data;
+
+    *gain=(u32)(10^((temp_gain*3)/200))*1024;
+    if (gain_reg[1].data & 0x10)
+       *gain = (*gain) * 2;
+
+    SENSOR_DMSG("[%s] get gain/reg (1024=1X)= %u/0x%x\n", __FUNCTION__, *gain,gain_reg[0].data);
+    //return rc;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    //double gain_double;
+    u64 gain_double;
+    params->expo.final_gain = gain;
+
+    if(gain<1024)
+       gain=1024;
+    else if(gain>=3980*1024)
+        gain=3980*1024;
+
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    params->tGain_reg[0].data=(u16)(((gain_double*10)>> 24)/3);
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain)
+{
+    //extern DBG_ITEM Dbg_Items[DBG_TAG_MAX];
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 i=0;
+    CUS_GAIN_GAP_ARRAY* Sensor_Gain_Linearity;
+    u64 gain_double;
+
+    params->expo.final_gain = gain;
+    if(gain < SENSOR_MIN_GAIN)
+        gain = SENSOR_MIN_GAIN;
+    else if(gain >= SENSOR_MAX_GAIN)
+        gain = SENSOR_MAX_GAIN;
+    Sensor_Gain_Linearity = gain_gap_compensate;
+
+    for(i = 0; i < sizeof(gain_gap_compensate)/sizeof(CUS_GAIN_GAP_ARRAY); i++){
+
+        if (Sensor_Gain_Linearity[i].gain == 0)
+            break;
+        if((gain>Sensor_Gain_Linearity[i].gain) && (gain < (Sensor_Gain_Linearity[i].gain + Sensor_Gain_Linearity[i].offset))){
+              gain=Sensor_Gain_Linearity[i].gain;
+              break;
+        }
+    }
+
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    params->tGain_reg[0].data=(u16)(((gain_double*10)>> 24)/3) & 0x00ff;
+    params->tGain_reg[1].data=(u16)((((gain_double*10)>> 24)/3) >> 8) & 0x0007;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data);
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static void pCus_SetAEGainHDR_DOL_Calculate(u32 gain, u16 *gain_reg)
+{
+    //double gain_double;
+    u64 gain_double;
+
+    if(gain < SENSOR_MIN_GAIN){
+      gain = SENSOR_MIN_GAIN;
+    }
+    else if(gain >= SENSOR_MAX_GAIN){
+      gain = SENSOR_MAX_GAIN;
+    }
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    *gain_reg=(u16)(((gain_double*10)>> 24)/3) & 0x07ff;
+}
+
+static int pCus_SetAEGainHDR_DOL_SEF1(ms_cus_sensor *handle, u32 gain)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_sef_reg[0].data = gain_reg & 0x00ff;
+    params->tGain_hdr_dol_sef_reg[1].data = (gain_reg>>8) & 0x0007;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_sef_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx335_mipi_linear[0].senout.min_fps;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = SENSOR_MIN_GAIN;//handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;//3980*1024;
+    return SUCCESS;
+}
+
+static int IMX335_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx335_mipi_linear[0].senout.min_fps;
+    info->min = (Preview_line_period * 9);
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+    u32 i, j;
+
+    for(i=0,j=0;i< num ;i++,j+=2){
+        gain_gap_compensate[i].gain=pArray[i].gain;
+        gain_gap_compensate[i].offset=pArray[i].offset;
+    }
+    return SUCCESS;
+}
+
+static int IMX335_GetShutterInfoHDR_DOL_SEF1(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    info->max = Preview_line_period_HDR_DOL * params->max_rhs1;
+    info->min = (Preview_line_period_HDR_DOL * 4);
+    info->step = Preview_line_period_HDR_DOL;
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx335_params *params;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx335_params *)handle->private_data;
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    //memcpy(params->tExpo_rhs1_reg, expo_rhs1_reg, sizeof(expo_rhs1_reg));
+    //memcpy(params->tExpo_shr_dol1_reg, expo_shr_dol1_reg, sizeof(expo_shr_dol1_reg));
+    //memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+    //memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF1_reg, sizeof(gain_HDR_DOL_SEF1_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX335_MIPI");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D8;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x34;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //300000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                    = Preview_MCLK_SPEED;//UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+    handle->orient                = SENSOR_ORIT;
+    //handle->YC_ODER               = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num    = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order   = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode  = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode    = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+   //handle->video_res_supported.num_res = LINEAR_RES_END;
+    for (res = 0; res < LINEAR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx335_mipi_linear[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx335_mipi_linear[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx335_mipi_linear[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx335_mipi_linear[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx335_mipi_linear[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx335_mipi_linear[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx335_mipi_linear[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx335_mipi_linear[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx335_mipi_linear[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release         = cus_camsensor_release_handle;
+    handle->pCus_sensor_init            = pCus_init_mipi4lane_5m30fps_linear;
+    //handle->pCus_sensor_powerupseq      = pCus_powerupseq;
+    handle->pCus_sensor_poweron         = pCus_poweron;
+    handle->pCus_sensor_poweroff        = pCus_poweroff;
+    handle->pCus_sensor_GetSensorID     = pCus_GetSensorID;
+    handle->pCus_sensor_GetVideoResNum  = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes     = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes     = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien        = pCus_GetOrien;
+    handle->pCus_sensor_SetOrien        = pCus_SetOrien;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode  = imx335_SetPatternMode;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT;
+    handle->ae_gain_ctrl_num           = 1;
+    handle->ae_shutter_ctrl_num        = 1;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;  //calibration
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = IMX335_GetShutterInfo;
+
+    params->expo.vts        = vts_30fps;
+    params->expo.expo_lines = 5000;
+    params->dirty           = false;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_sef1(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx335_params *params = NULL;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx335_params *)handle->private_data;
+    memcpy(params->tExpo_rhs1_reg, expo_rhs1_reg, sizeof(expo_rhs1_reg));
+    memcpy(params->tExpo_shr_dol1_reg, expo_shr_dol1_reg, sizeof(expo_shr_dol1_reg));
+    memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF1_reg, sizeof(gain_HDR_DOL_SEF1_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX335_MIPI_HDR_SEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                  = Preview_MCLK_SPEED_HDR_DOL;//UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC_DOL;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID_HDR_DOL;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+
+    handle->interface_attr.attr_mipi.mipi_lane_num                = SENSOR_MIPI_LANE_NUM_DOL;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB;
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_SONY_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx335_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx335_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx335_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx335_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx335_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx335_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx335_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx335_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx335_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release        = cus_camsensor_release_handle;
+    handle->pCus_sensor_init           = pCus_init_mipi4lane5m25fps_HDR_DOL;
+    handle->pCus_sensor_poweron        = pCus_poweron;               // Need to check
+    handle->pCus_sensor_poweroff       = pCus_poweroff;
+    handle->pCus_sensor_GetSensorID    = pCus_GetSensorID;
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes_HDR_DOL;
+    handle->pCus_sensor_GetVideoRes    = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes = pCus_GetCurVideoRes;
+
+    handle->pCus_sensor_GetOrien       = pCus_GetOrien;              // Need to check
+    handle->pCus_sensor_SetOrien       = pCus_SetOrien;              // Need to check
+    handle->pCus_sensor_GetFPS         = pCus_GetFPS_HDR_DOL_SEF1;
+    handle->pCus_sensor_SetFPS         = pCus_SetFPS_HDR_DOL_SEF1;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num           = 2;
+    handle->ae_shutter_ctrl_num        = 2;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;      //g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+    handle->pCus_sensor_GetShutterInfo  = IMX335_GetShutterInfoHDR_DOL_SEF1;
+    params->expo.vts                    = vts_30fps_HDR_DOL;
+    params->expo.expo_lines             = 4250;
+    return SUCCESS;
+}
+
+//lef functions
+static int pCus_init_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweron_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweroff_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_GetSensorID_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *id)
+{
+    *id = 0;
+     return SUCCESS;
+}
+
+static int pCus_GetOrien_HDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    *orit = CUS_ORIT_M0F0;
+    return SUCCESS;
+}
+
+static int pCus_SetOrien_HDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_LEF(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*(max_fps*1000))/fps;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > 2 * params->expo.vts - params->max_rhs1 -18){
+        vts = (params->expo.expo_lines + params->max_rhs1 + 18) / 2;
+    }else{
+        vts = params->expo.vts;
+    }
+
+    pCus_SetAEUSecsHDR_DOL_LEF(handle, params->expo.expo_lef_us);
+
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetSensorCap_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap)
+{
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+static int imx335_SetPatternMode_hdr_dol_lef(ms_cus_sensor *handle,u32 mode)
+{
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty || params->orien_dirty)
+            {
+                SensorReg_Write(0x3001,1);
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_shr_dol1_reg, ARRAY_SIZE(expo_shr_dol1_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_rhs1_reg, ARRAY_SIZE(expo_rhs1_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_lef_reg, ARRAY_SIZE(gain_HDR_DOL_LEF_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_sef_reg, ARRAY_SIZE(gain_HDR_DOL_SEF1_reg));
+
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *us)
+{
+    *us = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 qua_lines = 0,lines = 0, half_vts = 0, vts = 0, shr_dol0 = 0, fsc = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    qua_lines = (1000 * us) / Preview_line_period_HDR_DOL / 4;
+   // lines=us/Preview_line_period_HDR_DOL;
+    params->expo.expo_lef_us = us;
+
+    if (4 * qua_lines > 2 * params->expo.vts - params->max_rhs1 - 18) { // shs2 > max_rhs1 +2
+        half_vts = (4 * qua_lines + params->max_rhs1 + 19) / 4;
+    }
+    else{
+        half_vts = params->expo.vts / 2;
+    }
+
+    SENSOR_DMSG("[%s] us %u, qua_lines %u, vts %u\n", __FUNCTION__,
+                us,
+                qua_lines,
+                params->expo.vts
+                );
+
+    //exposure limit lines = fsc - (shs2 + 1) = fsc - 1 - ( rhs1 + 2 ~ fsc - 2) = 1 ~ fsc - 104 (rhs1 fix to 101)
+    vts = half_vts * 2;
+    fsc = half_vts * 4;
+    if(qua_lines < 1)  // shs2 < fsc - 2
+        qua_lines = 1;
+    if(4 * qua_lines > fsc - params->max_rhs1 - 18)
+        qua_lines = (fsc - params->max_rhs1 - 18) / 4;
+
+    lines = 4*qua_lines;
+    params->expo.expo_lines = lines;
+
+    shr_dol0 = fsc - lines;
+#if 0
+    printk("[%s] us %u, qua_lines %u, vts %u shr_dol0 %u\n", __FUNCTION__,
+                us,
+                qua_lines,
+                params->expo.vts,
+                shr_dol0
+                );
+#endif
+    params->tExpo_reg[0].data = (shr_dol0 >> 16) & 0x000f;
+    params->tExpo_reg[1].data = (shr_dol0 >> 8) & 0x00ff;
+    params->tExpo_reg[2].data = (shr_dol0 >> 0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x000f;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32* gain)
+{
+    *gain = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGainHDR_DOL_LEF(ms_cus_sensor *handle, u32 gain)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_lef_reg[0].data = gain_reg & 0x00ff;
+    params->tGain_hdr_dol_lef_reg[1].data = (gain_reg>>8) & 0x0007;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_lef_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx335_mipi_linear[0].senout.min_fps;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain_cal_hdr_dol_lef(ms_cus_sensor *handle, u32 gain)
+{
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity_hdr_dol_lef(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num)
+{
+    return SUCCESS;
+}
+
+static int IMX335_GetShutterInfo_hdr_dol_lef(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx335_mipi_linear[0].senout.min_fps;
+    info->min = (Preview_line_period_HDR_DOL * 4);
+    info->step = Preview_line_period_HDR_DOL;
+    return SUCCESS;
+}
+
+static int cus_camsensor_init_handle_hdr_dol_lef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx335_params *params;
+    s32 res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx335_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX335_MIPI_HDR_LEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                  = Preview_MCLK_SPEED_HDR_DOL;//UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+    //sensor_if->MCLK(0,1,handle->mclk);
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    handle->isp_type               = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt               = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus                = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec              = SENSOR_DATAPREC_DOL;  //CUS_DATAPRECISION_8;
+    handle->data_mode              = SENSOR_DATAMODE;
+    handle->bayer_id               = SENSOR_BAYERID_HDR_DOL;   //CUS_BAYER_GB;
+    handle->RGBIR_id               = SENSOR_RGBIRID;
+    handle->orient                 = SENSOR_ORIT;        //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num                = SENSOR_MIPI_LANE_NUM_DOL;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order               = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_SONY_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num =  0; //Long frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx335_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx335_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx335_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx335_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx335_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx335_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx335_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx335_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx335_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release         = cus_camsensor_release_handle;
+    handle->pCus_sensor_init            = pCus_init_HDR_DOL_LEF;
+    //handle->pCus_sensor_powerupseq    = pCus_powerupseq;
+    handle->pCus_sensor_poweron         = pCus_poweron_HDR_DOL_LEF;
+    handle->pCus_sensor_poweroff        = pCus_poweroff_HDR_DOL_LEF;
+    handle->pCus_sensor_GetSensorID     = pCus_GetSensorID_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetVideoResNum  = NULL;
+    //handle->pCus_sensor_GetVideoRes     = NULL;
+    //handle->pCus_sensor_GetCurVideoRes  = NULL;
+    //handle->pCus_sensor_SetVideoRes     = NULL;   // Need to check
+
+    handle->pCus_sensor_GetOrien        = pCus_GetOrien_HDR_DOL_LEF;
+    handle->pCus_sensor_SetOrien        = pCus_SetOrien_HDR_DOL_LEF;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_HDR_DOL_LEF;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_HDR_DOL_LEF;
+
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap_hdr_dol_lef;
+    handle->pCus_sensor_SetPatternMode  = imx335_SetPatternMode_hdr_dol_lef;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay               = SENSOR_GAIN_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_shutter_delay            = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num            = 2;
+    handle->ae_shutter_ctrl_num         = 2;
+    handle->sat_mingain                 = SENSOR_MIN_GAIN;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain_HDR_DOL_LEF;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal_hdr_dol_lef;
+    handle->pCus_sensor_setCaliData_gain_linearity = pCus_setCaliData_gain_linearity_hdr_dol_lef;
+    handle->pCus_sensor_GetShutterInfo  = IMX335_GetShutterInfo_hdr_dol_lef;
+
+    params->expo.vts                    = vts_30fps_HDR_DOL;
+    params->expo.expo_lines             = 673;
+    params->expo.fps                    = 25;
+    params->dirty                       = false;
+
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(IMX335_HDR,
+                            cus_camsensor_init_handle_linear,
+                            cus_camsensor_init_handle_hdr_dol_sef1,
+                            cus_camsensor_init_handle_hdr_dol_lef,
+                            imx335_params
+                         );
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc2239_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc2239_mipi.c
new file mode 100644
index 00000000..e8c52057
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc2239_mipi.c
@@ -0,0 +1,1086 @@
+/* SigmaStar trade secret */
+/* Copyright (c) [2019~2020] SigmaStar Technology.
+   All rights reserved.
+
+   Unless otherwise stipulated in writing, any and all information contained
+   herein regardless in any format shall remain the sole proprietary of
+   SigmaStar and be kept in strict confidence
+   (SigmaStar Confidential Information) by the recipient.
+   Any unauthorized act including without limitation unauthorized disclosure,
+   copying, use, reproduction, sale, distribution, modification, disassembling,
+   reverse engineering and compiling of the contents of SigmaStar Confidential
+   Information is unlawful and strictly prohibited. SigmaStar hereby reserves the
+   rights to any and all damages, losses, costs and expenses resulting therefrom.
+ */
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(SC2239);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE_LINEAR CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+//#define SENSOR_CHANNEL_MODE_SONY_DOL CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (1)
+//#define SENSOR_MIPI_HDR_MODE (1) //0: Non-HDR mode. 1:Sony DOL mode
+//MIPI config end.
+//============================================
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+//#undef SENSOR_DBG
+#define SENSOR_DBG 0
+
+#define SENSOR_ISP_TYPE          ISP_EXT                 //ISP_EXT, ISP_SOC
+#define SENSOR_IFBUS_TYPE        CUS_SENIF_BUS_MIPI     //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE   PACKET_HEADER_EDGE1
+#define SENSOR_DATAPREC          CUS_DATAPRECISION_10    //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE          CUS_SEN_10TO12_9000
+#define SENSOR_BAYERID           CUS_BAYER_BG            //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_RGBIRID           CUS_RGBIR_NONE
+#define SENSOR_ORIT              CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+#define SENSOR_MAXGAIN          (155*31)/10       //  (15.5*31)   max sensor gain, a-gain*conversion-gain*d-gain
+//#define SENSOR_YCORDER         CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+
+#define Preview_MCLK_SPEED       CUS_CMU_CLK_27MHZ        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+#define Preview_line_period      29630          //1/30/1500
+#define vts_30fps                1125                //for 30 fps
+
+#define Preview_WIDTH            1920                   //resolution Width when preview
+#define Preview_HEIGHT           1080                   //resolution Height when preview
+#define Preview_MAX_FPS          30  //25               //fastest preview FPS
+#define Preview_MIN_FPS          3                      //slowest preview FPS
+#define Preview_CROP_START_X     0                      //CROP_START_X
+#define Preview_CROP_START_Y     0                      //CROP_START_Y
+
+#define SENSOR_I2C_ADDR          0x60                   //I2C slave address
+#define SENSOR_I2C_SPEED         240000                 //I2C speed,60000~320000
+#define SENSOR_I2C_LEGACY        I2C_NORMAL_MODE        //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT           I2C_FMT_A16D8          //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL          CUS_CLK_POL_NEG        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL           CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+#define SENSOR_VSYNC_POL         CUS_CLK_POL_NEG        // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL         CUS_CLK_POL_POS        // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL          CUS_CLK_POL_POS        // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+static int cus_camsensor_release_handle(ms_cus_sensor *handle);
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+//#define ABS(a)   ((a)>(0) ? (a) : (-(a)))
+static int g_sensor_ae_min_gain = 1024;
+#define ENABLE_NR 1
+
+CUS_MCLK_FREQ UseParaMclk(void);
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 line;
+    } expo;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool reg_mf;
+    bool reg_dirty;
+    bool nr_dirty;
+    CUS_CAMSENSOR_ORIT cur_orien;
+} sc2239_params;
+// set sensor ID address and data,
+
+typedef struct {
+    u64 gain;
+    u8 fine_gain_reg;
+} FINE_GAIN;
+
+I2C_ARRAY Sensor_id_table[] =
+{
+    {0x3107, 0xCB},
+    {0x3108, 0x10},
+};
+
+I2C_ARRAY Sensor_init_table[] =
+{
+    //ipc_0x21_SC2239_MIPI_27Minput_1lane_10bit_742.5Mbps_1920x1080_30fps_non_continue
+    {0x0103,0x01}, //disable reset, just for 0x60&0x64 case
+    {0x0100,0x00},
+    {0x36e9,0x80},
+    {0x36f9,0x80},
+    {0x301f,0x21},
+    {0x3038,0x44},
+    {0x3253,0x12},
+    {0x3301,0x04},
+    {0x3304,0xa8},
+    {0x3306,0x44},
+    {0x3308,0x10},
+    {0x3309,0x48},
+    {0x330a,0x01},
+    {0x330b,0x40},
+    {0x331e,0xa1},
+    {0x331f,0x41},
+    {0x3333,0x10},
+    {0x3364,0x17},
+    {0x3390,0x08},
+    {0x3391,0x18},
+    {0x3392,0x38},
+    {0x3393,0x08},
+    {0x3394,0x0d},
+    {0x3395,0x70},
+    {0x33af,0x20},
+    {0x360f,0x01},
+    {0x3630,0x00},
+    {0x3634,0x64},
+    {0x3637,0x10},
+    {0x363c,0x05},
+    {0x3670,0x0c},
+    {0x3671,0xc2},
+    {0x3672,0x02},
+    {0x3673,0x02},
+    {0x3677,0x84},
+    {0x3678,0x84},
+    {0x3679,0x8e},
+    {0x367a,0x18},
+    {0x367b,0x38},
+    {0x367e,0x08},
+    {0x367f,0x38},
+    {0x3690,0x74},
+    {0x3691,0x64},
+    {0x3692,0x64},
+    {0x369c,0x08},
+    {0x369d,0x18},
+    {0x3904,0x08},
+    {0x3908,0x82},
+    {0x3933,0x82},
+    {0x3934,0x1b},
+    {0x3940,0x77},
+    {0x3941,0x18},
+    {0x3942,0x02},
+    {0x3943,0x1c},
+    {0x3944,0x0b},
+    {0x3945,0x80},
+    {0x3e01,0x8c},
+    {0x3e02,0x20},
+    {0x4509,0x20},
+    {0x4800,0x64},
+    {0x4819,0x09},
+    {0x481b,0x05},
+    {0x481d,0x14},
+    {0x4821,0x0a},
+    {0x4823,0x05},
+    {0x5000,0x06},
+    {0x5780,0x7f},
+    {0x5781,0x04},
+    {0x5782,0x03},
+    {0x5783,0x02},
+    {0x5784,0x01},
+    {0x5785,0x18},
+    {0x5786,0x10},
+    {0x5787,0x08},
+    {0x5788,0x02},
+    {0x5789,0x20},
+    {0x578a,0x7f},
+    {0x36e9,0x20},
+    {0x36f9,0x27},
+    {0x0100,0x01},
+    {0xffff,0x10}, //mdelay(10),
+};
+
+I2C_ARRAY mirror_reg[] = {
+    {0x3221, 0x00}, // mirror[2:1], flip[6:5]
+};
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+static I2C_ARRAY gain_reg[] = {
+    {0x3e06, 0x00},
+    {0x3e07, 0x80},//[7:0]
+    {0x3e08, 0x00|0x03},
+    {0x3e09, 0x20}, //low bit, 0x20 - 0x3f, step 1/32
+};
+
+I2C_ARRAY expo_reg[] = {
+    {0x3e00, 0x00}, //expo [20:17]
+    {0x3e01, 0x02}, // expo[15:8]
+    {0x3e02, 0x00}, // expo[7:0], [3:0] fraction of line
+};
+
+I2C_ARRAY vts_reg[] = {
+    {0x320e, 0x04},
+    {0x320f, 0x65},
+};
+
+#if ENABLE_NR
+I2C_ARRAY nr_reg[] = {
+    {0x3634,0x64},
+    {0x3306,0x44},
+    {0x3301,0x05},
+};
+#endif
+I2C_ARRAY PatternTbl[] = {
+    {0x4501,0xc8}, //testpattern , bit 3 to enable
+};
+
+CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+/*
+/////////// function definition ///////////////////
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+#define SENSOR_DMSG(args...)
+#endif
+#undef SENSOR_NAME
+#define SENSOR_NAME sc2239
+*/
+
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+//int cus_camsensor_release_handle(ms_cus_sensor *handle);
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);////pwd low
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    CamOsMsSleep(1);
+    //Sensor power on sequence
+    sensor_if->MCLK(idx, 1, handle->mclk);
+
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    //sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    //sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    //sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+    CamOsMsSleep(2);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    CamOsMsSleep(1);
+
+    SENSOR_DMSG("[%s] pwd high\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, !handle->reset_POLARITY);
+    CamOsMsSleep(5);
+
+    //sensor_if->Set3ATaskOrder(handle, def_order);
+    // pure power on
+    //ISP_config_io(handle);
+   // sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+   // CamOsMsSleep(5);
+    //handle->i2c_bus->i2c_open(handle->i2c_bus,&handle->i2c_cfg);
+
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    SENSOR_DMSG("[%s] power low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    //handle->i2c_bus->i2c_close(handle->i2c_bus);
+    CamOsMsSleep(1);
+    //Set_csi_if(0, 0);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    params->cur_orien = CUS_ORIT_M0F0;
+
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+  int i,n;
+  int table_length= ARRAY_SIZE(Sensor_id_table);
+  I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+  SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+  for(n=0;n<table_length;++n) {
+    id_from_sensor[n].reg = Sensor_id_table[n].reg;
+    id_from_sensor[n].data = 0;
+  }
+
+  *id =0;
+  if(table_length>8) table_length=8;
+  for(n=0; n<4; ++n) {              //retry , until I2C success
+    if(n>2) return FAIL;
+    if(SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+        break;
+    else
+        CamOsMsSleep(1);
+  }
+
+    for(i=0; i<table_length; ++i) {
+    if (id_from_sensor[i].data != Sensor_id_table[i].data)
+            return FAIL;
+    *id = ((*id)+ id_from_sensor[i].data)<<8;
+  }
+  *id >>= 8;
+    SENSOR_DMSG("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+
+    return SUCCESS;
+}
+
+static int sc2239_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+  int i;
+  SENSOR_DMSG("\n\n[%s], mode=%d \n", __FUNCTION__, mode);
+
+  switch(mode) {
+  case 1:
+    PatternTbl[0].data = 0xc8; //enable
+    break;
+  case 0:
+    PatternTbl[0].data = 0xc0; //disable
+    break;
+  default:
+    PatternTbl[0].data = 0xc0; //disable
+    break;
+  }
+  for(i=0; i< ARRAY_SIZE(PatternTbl); i++) {
+      if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+            return FAIL;
+  }
+
+  return SUCCESS;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain);
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+static int pCus_init(ms_cus_sensor *handle)
+{
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    SensorReg_Write(0x3011,0x60);
+    SensorReg_Write(0x3004,0x60);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table);i++)
+    {
+        if(Sensor_init_table[i].reg==0x0100 && 0x01 == Sensor_init_table[i].data)
+        {
+            sensor_if->SetCSI_Clk(0, CUS_CSI_CLK_216M);
+            sensor_if->SetCSI_Lane(0, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+            sensor_if->SetCSI_LongPacketType(0, 0, 0x1C00, 0);
+            SENSOR_MSLEEP(50);
+        }
+
+        if(Sensor_init_table[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table[i].reg, Sensor_init_table[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = &handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0: //"1920x1080@30fps"
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init;
+            break;
+
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit) {
+    char sen_data;
+    sen_data = mirror_reg[0].data;
+    SENSOR_DMSG("mirror:%x\r\n", sen_data);
+    switch(sen_data)
+    {
+        case 0x00:
+            *orit = CUS_ORIT_M0F0;
+            break;
+        case 0x06:
+            *orit = CUS_ORIT_M1F0;
+            break;
+        case 0x60:
+            *orit = CUS_ORIT_M0F1;
+            break;
+        case 0x66:
+            *orit = CUS_ORIT_M1F1;
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            mirror_reg[0].data = 0x00;
+            params->cur_orien = CUS_ORIT_M0F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F0:
+            mirror_reg[0].data = 0x06;
+            params->cur_orien = CUS_ORIT_M1F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M0F1:
+            mirror_reg[0].data = 0x60;
+            params->cur_orien = CUS_ORIT_M0F1;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F1:
+            mirror_reg[0].data = 0x66;
+            params->cur_orien = CUS_ORIT_M1F1;
+            params->reg_mf = true;
+            break;
+        default :
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (vts_reg[0].data << 8) | (vts_reg[1].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts=0;
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*(max_fps*1000))/fps;
+    }else{
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.line > 2*(params->expo.vts) -8){
+        vts = (params->expo.line + 9)/2;
+    }else{
+        vts = params->expo.vts;
+    }
+
+    vts_reg[0].data = (vts >> 8) & 0x00ff;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+    params->reg_dirty = true;
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap) {
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+
+        break;
+        case CUS_FRAME_ACTIVE:
+         if(params->reg_mf)
+            {
+                SensorRegArrayW((I2C_ARRAY*)mirror_reg, sizeof(mirror_reg)/sizeof(I2C_ARRAY));
+                params->reg_mf = false;
+            }
+            if(params->reg_dirty)
+            {
+                SensorRegArrayW((I2C_ARRAY*)expo_reg, sizeof(expo_reg)/sizeof(I2C_ARRAY));
+                SensorRegArrayW((I2C_ARRAY*)gain_reg, sizeof(gain_reg)/sizeof(I2C_ARRAY));
+                SensorRegArrayW((I2C_ARRAY*)vts_reg, sizeof(vts_reg)/sizeof(I2C_ARRAY));
+                params->reg_dirty = false;
+            }
+#if ENABLE_NR
+            if(params->nr_dirty)
+            {
+                SensorReg_Write(0x3812,0x00);
+                SensorRegArrayW((I2C_ARRAY*)nr_reg, sizeof(nr_reg)/sizeof(I2C_ARRAY));
+                params->nr_dirty = false;
+                SensorReg_Write(0x3812,0x30);
+            }
+#endif
+        break;
+        default :
+        break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us) {
+  int rc=0;
+  u32 lines = 0;
+    lines |= (u32)(expo_reg[0].data&0x000f)<<16;
+    lines |= (u32)(expo_reg[1].data&0x00ff)<<8;
+    lines |= (u32)(expo_reg[2].data&0x00f0)<<0;
+    lines >>= 4;
+    *us = (lines*Preview_line_period)/1000/2; //return us
+
+  SENSOR_DMSG("[%s] sensor expo lines/us %d, %dus\n", __FUNCTION__, lines, *us);
+  return rc;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us) {
+    int i;
+    u32 half_lines = 0,vts = 0;
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    I2C_ARRAY expo_reg_temp[] = {  // max expo line vts-4!
+    {0x3e00, 0x00},//expo [20:17]
+    {0x3e01, 0x00}, // expo[16:8]
+    {0x3e02, 0x10}, // expo[7:0], [3:0] fraction of line
+    };
+    memcpy(expo_reg_temp, expo_reg, sizeof(expo_reg));
+
+    half_lines = (1000*us*2)/Preview_line_period; // Preview_line_period in ns
+    if(half_lines<2) half_lines=2;
+    if (half_lines >  2 * (params->expo.vts)-8) {
+        vts = (half_lines+9)/2;
+    }
+    else
+        vts=params->expo.vts;
+    params->expo.line = half_lines;
+    SENSOR_DMSG("[%s] us %ld, half_lines %ld, vts %ld\n", __FUNCTION__, us, half_lines, params->expo.vts);
+
+    half_lines = half_lines<<4;
+//  printf("===================================================================\n");
+//  printf("us = %d  half_lines = %x params->expo.vts = %x\n",us, half_lines, params->expo.vts);
+//  printf("===================================================================\n");
+    expo_reg[0].data = (half_lines>>16) & 0x0f;
+    expo_reg[1].data =  (half_lines>>8) & 0xff;
+    expo_reg[2].data = (half_lines>>0) & 0xf0;
+    vts_reg[0].data = (vts >> 8) & 0x00ff;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+
+    for (i = 0; i < sizeof(expo_reg)/sizeof(I2C_ARRAY); i++)
+    {
+      if (expo_reg[i].data != expo_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+     }
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain) {
+    int rc = 0;
+
+    return rc;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain) {
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain) {
+    sc2239_params *params = (sc2239_params *)handle->private_data;
+    int i = 0;
+    u8 Dgain_reg = 0, Cgain_reg = 0, Fine_again_reg= 0x20,Fine_dgain_reg= 0x80;
+
+    I2C_ARRAY gain_reg_temp[] = {
+        {0x3e06, 0x00},
+        {0x3e07, 0x80},
+        {0x3e08, (0x00|0x03)},
+        {0x3e09, 0x20},
+    };
+    I2C_ARRAY nr_reg_temp[] ={
+        {0x3634, 0x64},
+        {0x3306, 0x44},
+        {0x3301, 0x05},
+    };
+    memcpy(gain_reg_temp, gain_reg, sizeof(gain_reg));
+    memcpy(nr_reg_temp, nr_reg, sizeof(nr_reg));
+
+    if (gain<1024){
+        gain=1024;
+    }else if (gain>=SENSOR_MAXGAIN*1024){
+        gain=SENSOR_MAXGAIN*1024;
+    }
+
+    if (gain < 2 * 1024)
+    {
+        Cgain_reg = 0x03;  Fine_again_reg = gain>>5;
+        Dgain_reg = 0;  Fine_dgain_reg = (gain<<2)/Fine_again_reg;
+    }
+    else if (gain <  4 * 1024)
+    {
+        Cgain_reg = 0x07;  Fine_again_reg = gain>>6;
+        Dgain_reg = 0;  Fine_dgain_reg = (gain<<1)/Fine_again_reg;
+    }
+    else if (gain < 8 * 1024)
+    {
+        Cgain_reg = 0x0f;  Fine_again_reg = gain>>7;
+        Dgain_reg = 0;  Fine_dgain_reg = gain/Fine_again_reg;
+    }
+    else if (gain <=  16128)
+    {
+        Cgain_reg = 0x1f;  Fine_again_reg = gain>>8;
+        Dgain_reg = 0;  Fine_dgain_reg = (gain>>1)/Fine_again_reg;
+    }
+    else if (gain < 32256)
+    {
+        Cgain_reg = 0x1f;  Fine_again_reg = 0x3f;
+        Dgain_reg = 0;  Fine_dgain_reg = gain/126;
+    }
+    else if (gain < 63 * 1024)
+    {
+        Cgain_reg = 0x1f;  Fine_again_reg = 0x3f;
+        Dgain_reg = 1;  Fine_dgain_reg = gain/252;
+    }
+    else if (gain < 126 * 1024)
+    {
+        Cgain_reg = 0x1f;  Fine_again_reg = 0x3f;
+        Dgain_reg = 3;  Fine_dgain_reg = gain/504;
+    }
+    else if (gain < 252 * 1024)
+    {
+        Cgain_reg = 0x1f;  Fine_again_reg = 0x3f;
+        Dgain_reg = 7;  Fine_dgain_reg = gain/1008;
+    }else if (gain <= SENSOR_MAXGAIN * 1024)
+    {
+        Cgain_reg = 0x1f;  Fine_again_reg = 0x3f;
+        Dgain_reg = 0x0f;  Fine_dgain_reg = gain/2016;
+    }
+
+    gain_reg[3].data = Fine_again_reg;
+    gain_reg[2].data = Cgain_reg;
+    gain_reg[1].data = Fine_dgain_reg;
+    gain_reg[0].data = Dgain_reg & 0x0f;
+
+#if ENABLE_NR
+    if (gain_reg_temp[2].data == 0x03 && gain_reg_temp[3].data <= 0x28)
+    {
+        nr_reg[0].data = 0x64;  //0x05;
+        nr_reg[1].data = 0x44;
+        nr_reg[2].data = 0x04;
+    } else if (gain_reg_temp[2].data < 0x07)
+    {
+        nr_reg[0].data = 0x64;  //0x05;
+        nr_reg[1].data = 0x68;
+        nr_reg[2].data = 0x05;
+    } else if (gain_reg_temp[2].data < 0x0f)
+    {
+        nr_reg[0].data = 0x64;  //0x05;
+        nr_reg[1].data = 0x68;
+        nr_reg[2].data = 0x05;
+    } else if (gain_reg_temp[2].data < 0x1f)
+    {
+        nr_reg[0].data = 0x44;  //0x05;
+        nr_reg[1].data = 0x68;
+        nr_reg[2].data = 0x05;
+    } else if (gain_reg_temp[2].data == 0x1f)
+    {
+        nr_reg[0].data = 0x24;  //0x14;
+        nr_reg[1].data = 0x68;
+        nr_reg[2].data = 0x05;
+    }
+
+   #if 1
+    /* Each frame refresh to avoid the red flash when linear and wide dynamic switching */
+    for (i = 0; i < sizeof(nr_reg)/sizeof(I2C_ARRAY); i++)
+    {
+      if (nr_reg[i].data != nr_reg_temp[i].data)
+      {
+        params->nr_dirty = true;
+        break;
+      }
+    }
+    #endif
+#endif
+
+    for (i = 0; i < sizeof(gain_reg)/sizeof(I2C_ARRAY); i++)
+    {
+      if (gain_reg[i].data != gain_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min = 1;
+    *max = 1000000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max) {
+  *min = 1024;
+  *max = SENSOR_MAXGAIN*1024;
+  return SUCCESS;
+}
+
+static int sc2239_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = Preview_line_period;
+    info->step = Preview_line_period/2;
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle) {
+   ms_cus_sensor *handle = drv_handle;
+    sc2239_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (sc2239_params *)handle->private_data;
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    strcpy(handle->model_id,"sc2239_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth= 1920;
+    handle->video_res_supported.res[0].nOutputHeight= 1080;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "1920x1080@30fps");
+
+    // i2c
+
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 2;
+    handle->ae_shutter_delay    = 2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 1;
+
+    ///calibration
+    handle->sat_mingain=g_sensor_ae_min_gain;
+
+
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init;
+
+    handle->pCus_sensor_poweron     = pCus_poweron ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = sc2239_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = sc2239_GetShutterInfo;
+    params->expo.vts=vts_30fps;
+    params->expo.fps = 30;
+    params->expo.line= 1000;
+    params->reg_dirty = false;
+    params->reg_mf = false;
+    params->nr_dirty = false;
+    return SUCCESS;
+}
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(  SC2239,
+                            cus_camsensor_init_handle_linear,
+                            NULL,
+                            NULL,
+                            sc2239_params
+                         );
\ No newline at end of file
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc2335_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc2335_mipi.c
new file mode 100644
index 00000000..8cff6d94
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc2335_mipi.c
@@ -0,0 +1,1107 @@
+/* SigmaStar trade secret */
+/* Copyright (c) [2019~2020] SigmaStar Technology.
+   All rights reserved.
+
+   Unless otherwise stipulated in writing, any and all information contained
+   herein regardless in any format shall remain the sole proprietary of
+   SigmaStar and be kept in strict confidence
+   (SigmaStar Confidential Information) by the recipient.
+   Any unauthorized act including without limitation unauthorized disclosure,
+   copying, use, reproduction, sale, distribution, modification, disassembling,
+   reverse engineering and compiling of the contents of SigmaStar Confidential
+   Information is unlawful and strictly prohibited. SigmaStar hereby reserves the
+   rights to any and all damages, losses, costs and expenses resulting therefrom.
+ */
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(SC2335);
+
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE_LINEAR CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+//#define SENSOR_CHANNEL_MODE_SONY_DOL CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (2)
+//#define SENSOR_MIPI_HDR_MODE (1) //0: Non-HDR mode. 1:Sony DOL mode
+//MIPI config end.
+//============================================
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+//#undef SENSOR_DBG
+#define SENSOR_DBG 0
+
+#define SENSOR_ISP_TYPE     ISP_EXT                 //ISP_EXT, ISP_SOC
+#define SENSOR_IFBUS_TYPE   CUS_SENIF_BUS_MIPI     //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE PACKET_HEADER_EDGE1
+#define SENSOR_DATAPREC     CUS_DATAPRECISION_10    //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE     CUS_SEN_10TO12_9000
+#define SENSOR_BAYERID      CUS_BAYER_BG            //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_RGBIRID      CUS_RGBIR_NONE
+#define SENSOR_ORIT         CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+#define SENSOR_MAXGAIN      (15875*31)/1000       //  (15.5*31)   max sensor gain, a-gain*conversion-gain*d-gain
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+
+#define Preview_MCLK_SPEED  CUS_CMU_CLK_27MHZ        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+//#define Preview_line_period 30000                  ////HTS/PCLK=4455 pixels/148.5MHZ=30usec @MCLK=36MHz
+//#define vts_30fps 1125//1346,1616                 //for 29.1fps @ MCLK=36MHz
+//#define Line_per_second     32727
+//#define vts_30fps
+#define Preview_line_period 29630          //1/30/1500
+#define vts_30fps           1125                //for 30 fps
+
+#define Preview_WIDTH       1920                   //resolution Width when preview
+#define Preview_HEIGHT      1080                  //resolution Height when preview
+#define Preview_MAX_FPS     30  //25                     //fastest preview FPS
+#define Preview_MIN_FPS     3                       //slowest preview FPS
+#define Preview_CROP_START_X     0                      //CROP_START_X
+#define Preview_CROP_START_Y     0                      //CROP_START_Y
+
+#define SENSOR_I2C_ADDR     0x60                   //I2C slave address
+#define SENSOR_I2C_SPEED    240000                  //I2C speed,60000~320000
+
+#define SENSOR_I2C_LEGACY  I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT     I2C_FMT_A16D8        //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL     CUS_CLK_POL_NEG        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL      CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+
+#define SENSOR_VSYNC_POL    CUS_CLK_POL_NEG            // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL    CUS_CLK_POL_POS         // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL     CUS_CLK_POL_POS         // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+#define ENABLE_NR 1
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+static int g_sensor_ae_min_gain = 1024;
+
+CUS_MCLK_FREQ UseParaMclk(void);
+
+typedef struct {
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 half_lines;
+        u32 half_line;
+        u32 fps;
+        u32 preview_fps;
+        u32 line;
+    } expo;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool reg_mf;
+    bool reg_dirty;
+    bool nr_dirty;
+    bool temperature_reg_1_dirty;
+//    bool temperature_reg_2_dirty;
+    CUS_CAMSENSOR_ORIT cur_orien;
+} sc2335_params;
+// set sensor ID address and data,
+
+typedef struct {
+    u64 gain;
+    u8 fine_gain_reg;
+} FINE_GAIN;
+
+I2C_ARRAY Sensor_id_table[] = {
+    {0x3107, 0xCB},
+    {0x3108, 0x14}, // 0x07
+};
+
+I2C_ARRAY Sensor_init_table_2M30fps[] = {
+    // printf("===SC2335_mipi_lane2_bit10_1080P_30fps_20200309\n");
+    {0x0103,0x01},
+    {0xffff,0x50},
+    {0x0100,0x00},
+    {0x36e9,0x80},
+    {0x36f9,0x80},
+    {0x301f,0x02},
+    {0x3207,0x3f},
+    {0x3249,0x0f},
+    {0x3253,0x08},
+    {0x3271,0x00},
+    {0x3273,0x03},
+    {0x3301,0x06},
+    {0x3302,0x09},
+    {0x3304,0x28},
+    {0x3306,0x30},
+    {0x330b,0x94},
+    {0x330c,0x08},
+    {0x330d,0x18},
+    {0x330e,0x14},
+    {0x330f,0x05},
+    {0x3310,0x06},
+    {0x3314,0x96},
+    {0x3316,0x00},
+    {0x331e,0x21},
+    {0x332b,0x08},
+    {0x3333,0x10},
+    {0x3338,0x80},
+    {0x333a,0x04},
+    {0x334c,0x04},
+    {0x335f,0x04},
+    {0x3364,0x17},
+    {0x3366,0x62},
+    {0x337c,0x05},
+    {0x337d,0x09},
+    {0x337e,0x00},
+    {0x3390,0x08},
+    {0x3391,0x18},
+    {0x3392,0x38},
+    {0x3393,0x09},
+    {0x3394,0x20},
+    {0x3395,0x20},
+    {0x33a2,0x07},
+    {0x33ac,0x04},
+    {0x33ae,0x14},
+    {0x3614,0x00},
+    {0x3622,0x16},
+    {0x3630,0x68},
+    {0x3631,0x84},
+    {0x3637,0x20},
+    {0x363a,0x1f},
+    {0x363c,0x0e},
+    {0x3670,0x0e},
+    {0x3674,0xa1},
+    {0x3675,0x9c},
+    {0x3676,0x9e},
+    {0x3677,0x84},
+    {0x3678,0x85},
+    {0x3679,0x87},
+    {0x367c,0x18},
+    {0x367d,0x38},
+    {0x367e,0x08},
+    {0x367f,0x18},
+    {0x3690,0x32},
+    {0x3691,0x32},
+    {0x3692,0x44},
+    {0x369c,0x08},
+    {0x369d,0x38},
+    {0x3908,0x82},
+    {0x391f,0x18},
+    {0x3e01,0x8c},
+    {0x3e02,0x00},
+    {0x3f00,0x0d},
+    {0x3f04,0x02},
+    {0x3f05,0x0e},
+    {0x3f09,0x48},
+    {0x4505,0x0a},
+    {0x4509,0x20},
+    {0x481d,0x0a},
+    {0x4827,0x03},
+    {0x5787,0x10},
+    {0x5788,0x06},
+    {0x578a,0x10},
+    {0x578b,0x06},
+    {0x5790,0x10},
+    {0x5791,0x10},
+    {0x5792,0x00},
+    {0x5793,0x10},
+    {0x5794,0x10},
+    {0x5795,0x00},
+    {0x5799,0x00},
+    {0x57c7,0x10},
+    {0x57c8,0x06},
+    {0x57ca,0x10},
+    {0x57cb,0x06},
+    {0x57d1,0x10},
+    {0x57d4,0x10},
+    {0x57d9,0x00},
+    {0x36e9,0x20},// pll
+    {0x36f9,0x27},
+    {0x0100,0x01},
+    {0xffff,0x50},
+};
+
+I2C_ARRAY mirror_reg[] = {
+    {0x3221, 0x00}, // mirror[2:1], flip[6:5]
+};
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+static I2C_ARRAY gain_reg[] = {
+    {0x3e06, 0x00},
+    {0x3e07, 0x80}, // 128
+    {0x3e08, 0x03},
+    {0x3e09, 0x40}, // 64
+};
+
+I2C_ARRAY expo_reg[] = {
+    {0x3e00, 0x00}, //expo [20:17]
+    {0x3e01, 0x02}, // expo[15:8]
+    {0x3e02, 0x00}, // expo[7:0], [3:0] fraction of line
+};
+
+I2C_ARRAY vts_reg[] = {
+    {0x320e, 0x04},
+    {0x320f, 0x65},
+};
+
+#if ENABLE_NR
+I2C_ARRAY nr_reg[] = {
+    {0x363c, 0x0e},
+};
+#endif
+
+I2C_ARRAY temperature_reg_1[] = {
+    {0x5799, 0x07},
+};
+
+I2C_ARRAY PatternTbl[] = {
+    {0x4501,0xb4}, //testpattern , bit 3 to enable
+};
+
+#if 0
+CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////// function definition ///////////////////
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+#undef SENSOR_NAME
+#define SENSOR_NAME ov2710
+
+
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus,&(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus,&(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+int cus_camsensor_release_handle(ms_cus_sensor *handle);
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);////pwd low
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    CamOsMsSleep(1);
+    //Sensor power on sequence
+    sensor_if->MCLK(idx, 1, handle->mclk);
+
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    //sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    //sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    //sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+    CamOsMsSleep(2);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    CamOsMsSleep(1);
+
+    SENSOR_DMSG("[%s] pwd high\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, !handle->reset_POLARITY);
+    CamOsMsSleep(2);
+
+    //sensor_if->Set3ATaskOrder(handle, def_order);
+    // pure power on
+    //ISP_config_io(handle);
+   // sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+   // CamOsMsSleep(5);
+    //handle->i2c_bus->i2c_open(handle->i2c_bus,&handle->i2c_cfg);
+
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sc2335_params *params = (sc2335_params *)handle->private_data;
+    SENSOR_DMSG("[%s] power low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    //handle->i2c_bus->i2c_close(handle->i2c_bus);
+    CamOsMsSleep(1);
+    //Set_csi_if(0, 0);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    params->cur_orien = CUS_ORIT_M0F0;
+
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+  int i,n;
+  int table_length= ARRAY_SIZE(Sensor_id_table);
+  I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+  SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    //printk("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+  for(n=0;n<table_length;++n) {
+    id_from_sensor[n].reg = Sensor_id_table[n].reg;
+    id_from_sensor[n].data = 0;
+  }
+
+  *id =0;
+  if(table_length>8) table_length=8;
+  for(n=0; n<4; ++n) {              //retry , until I2C success
+    if(n>2) return FAIL;
+    if(SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+        break;
+    else
+        CamOsMsSleep(1);
+  }
+
+    for(i=0; i<table_length; ++i) {
+    if (id_from_sensor[i].data != Sensor_id_table[i].data)
+            return FAIL;
+    *id = ((*id)+ id_from_sensor[i].data)<<8;
+  }
+  *id >>= 8;
+    SENSOR_DMSG("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    //printk("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+
+
+    return SUCCESS;
+}
+
+static int sc2335_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+  int i;
+  SENSOR_DMSG("\n\n[%s], mode=%d \n", __FUNCTION__, mode);
+
+  switch(mode) {
+  case 1:
+    PatternTbl[0].data = 0xbc; //enable
+    break;
+  case 0:
+    PatternTbl[0].data = 0xb4; //disable
+    break;
+  default:
+    PatternTbl[0].data = 0xb4; //disable
+    break;
+  }
+  for(i=0; i< ARRAY_SIZE(PatternTbl); i++) {
+      if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+            return FAIL;
+  }
+
+  return SUCCESS;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain);
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+
+static u16 reg3040;
+
+static int pCus_init(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sc2335_params *params = (sc2335_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+
+    //logic
+    SensorReg_Read(0x3040, &reg3040);
+
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_2M30fps);i++)
+    {
+        if(Sensor_init_table_2M30fps[i].reg==0x0100 && 0x01 == Sensor_init_table_2M30fps[i].data)
+        {
+            //platform dependent
+            SensorReg_Write(0x3802, 0x00);  //sync
+            sensor_if->SetCSI_Clk(0, CUS_CSI_CLK_216M);
+            sensor_if->SetCSI_Lane(0, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+            sensor_if->SetCSI_LongPacketType(0, 0, 0x1C00, 0);
+            SENSOR_MSLEEP(50);
+        }
+
+        if(Sensor_init_table_2M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_2M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_2M30fps[i].reg, Sensor_init_table_2M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    if(reg3040 == 0x40) {
+        SensorReg_Write(0x363c, 0x0e);
+    } else {
+        SensorReg_Write(0x363c, 0x0f);
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = &handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0: //"1920x1080@30fps"
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init;
+            break;
+
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit) {
+    char sen_data;
+    sen_data = mirror_reg[0].data;
+    SENSOR_DMSG("mirror:%x\r\n", sen_data);
+    switch(sen_data & 0x66)
+    {
+        case 0x00:
+            *orit = CUS_ORIT_M0F0;
+            break;
+        case 0x06:
+            *orit = CUS_ORIT_M1F0;
+            break;
+        case 0x60:
+            *orit = CUS_ORIT_M0F1;
+            break;
+        case 0x66:
+            *orit = CUS_ORIT_M1F1;
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+   sc2335_params *params = (sc2335_params *)handle->private_data;
+  //  pr_info("Connect %s table_length %d\n",__FUNCTION__, table_length);
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            mirror_reg[0].data = 0x00;
+            params->cur_orien = CUS_ORIT_M0F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F0:
+            mirror_reg[0].data = 0x06;
+            params->cur_orien = CUS_ORIT_M1F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M0F1:
+            mirror_reg[0].data = 0x60;
+            params->cur_orien = CUS_ORIT_M0F1;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F1:
+            mirror_reg[0].data = 0x66;
+            params->cur_orien = CUS_ORIT_M1F1;
+            params->reg_mf = true;
+            break;
+        default :
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    sc2335_params *params = (sc2335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (vts_reg[0].data << 8) | (vts_reg[1].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts=0;
+    sc2335_params *params = (sc2335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*(max_fps*1000))/fps;
+    }else{
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.line > 2* (params->expo.vts) -10){
+        vts = (params->expo.line + 11)/2;
+    }else{
+        vts = params->expo.vts;
+    }
+
+    vts_reg[0].data = (vts >> 8) & 0x00ff;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+    params->reg_dirty = true;
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap) {
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    sc2335_params *params = (sc2335_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+        break;
+        case CUS_FRAME_ACTIVE:
+         if(params->reg_mf) {
+            SensorRegArrayW((I2C_ARRAY*)mirror_reg, sizeof(mirror_reg)/sizeof(I2C_ARRAY));
+            params->reg_mf = false;
+        }
+        if(params->reg_dirty) {
+            SensorRegArrayW((I2C_ARRAY*)expo_reg, sizeof(expo_reg)/sizeof(I2C_ARRAY));
+            SensorRegArrayW((I2C_ARRAY*)gain_reg, sizeof(gain_reg)/sizeof(I2C_ARRAY));
+            SensorRegArrayW((I2C_ARRAY*)vts_reg, sizeof(vts_reg)/sizeof(I2C_ARRAY));
+            params->reg_dirty = false;
+        }
+#if ENABLE_NR
+
+        if(params->nr_dirty || params->temperature_reg_1_dirty) {
+            SensorReg_Write(0x3812,0x00);
+            if(params->nr_dirty) {
+                SensorRegArrayW((I2C_ARRAY*)nr_reg, sizeof(nr_reg)/sizeof(I2C_ARRAY));
+                params->nr_dirty = false;
+            }
+            if(params->temperature_reg_1_dirty) {
+                SensorRegArrayW((I2C_ARRAY*)temperature_reg_1, sizeof(temperature_reg_1)/sizeof(I2C_ARRAY));
+                params->temperature_reg_1_dirty = false;
+            }
+            SensorReg_Write(0x3812,0x30);
+        }
+#endif
+
+        break;
+        default :
+        break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us) {
+  int rc=0;
+  u32 lines = 0;
+    lines |= (u32)(expo_reg[0].data&0x000f)<<16;
+    lines |= (u32)(expo_reg[1].data&0x00ff)<<8;
+    lines |= (u32)(expo_reg[2].data&0x00f0)<<0;
+    lines >>= 4;
+    *us = (lines*Preview_line_period)/1000/2; //return us
+
+  SENSOR_DMSG("[%s] sensor expo lines/us %d, %dus\n", __FUNCTION__, lines, *us);
+  return rc;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us) {
+    int i;
+    u32 half_lines = 0,vts = 0;
+    sc2335_params *params = (sc2335_params *)handle->private_data;
+    I2C_ARRAY expo_reg_temp[] = {  // max expo line vts-4!
+    {0x3e00, 0x00},//expo [20:17]
+    {0x3e01, 0x00}, // expo[16:8]
+    {0x3e02, 0x10}, // expo[7:0], [3:0] fraction of line
+    };
+    memcpy(expo_reg_temp, expo_reg, sizeof(expo_reg));
+
+    half_lines = (1000*us*2)/Preview_line_period; // Preview_line_period in ns
+    if(half_lines<2)
+        half_lines=2;
+    if (half_lines >  2 * (params->expo.vts) - 10) {
+        vts = (half_lines+11)/2;
+    }
+    else
+        vts= params->expo.vts;
+
+    params->expo.line = half_lines;
+    SENSOR_DMSG("[%s] us %ld, half_lines %ld, vts %ld\n", __FUNCTION__, us, half_lines, params->expo.vts);
+
+    half_lines = half_lines<<4;
+    // printk("us = %d  half_lines = %x params->expo.vts = %x\n",us, half_lines, params->expo.vts);
+    expo_reg[0].data = (half_lines>>16) & 0x0f;
+    expo_reg[1].data =  (half_lines>>8) & 0xff;
+    expo_reg[2].data = (half_lines>>0) & 0xf0;
+    vts_reg[0].data = (vts >> 8) & 0x00ff;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+
+    for (i = 0; i < sizeof(expo_reg)/sizeof(I2C_ARRAY); i++) {
+      if (expo_reg[i].data != expo_reg_temp[i].data) {
+        params->reg_dirty = true;
+        break;
+      }
+    }
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain) {
+    int rc = 0;
+
+    return rc;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain) {
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain) {
+    sc2335_params *params = (sc2335_params *)handle->private_data;
+    u8 i=0 ,Dgain = 1,  Ana_gain = 1;
+    u64 Fine_againx64 = 64,Fine_dgainx128 = 128;
+    u8 Dgain_reg = 0, Ana_gain_reg = 0, Fine_again_reg= 0x40,Fine_dgain_reg= 0x80;
+
+    I2C_ARRAY gain_reg_temp[] = {
+        {0x3e06, 0x00},
+        {0x3e07, 0x80},
+        {0x3e08, 0x03},
+        {0x3e09, 0x40},
+    };
+    I2C_ARRAY nr_reg_temp[] ={
+        {0x363c, 0x0e},
+    };
+    I2C_ARRAY temperature_reg_1_temp[] ={
+        {0x5799, 0x07},
+    };
+
+    memcpy(gain_reg_temp, gain_reg, sizeof(gain_reg));
+    memcpy(nr_reg_temp, nr_reg, sizeof(nr_reg));
+    memcpy(temperature_reg_1_temp, temperature_reg_1, sizeof(temperature_reg_1));
+
+    if (gain<1024){
+        gain=1024;
+    }else if (gain>=SENSOR_MAXGAIN*1024){
+        gain=SENSOR_MAXGAIN*1024;
+    }
+
+    if (gain < 2 * 1024) {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 1;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x03;
+    } else if (gain < 4 * 1024) {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 2;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x07;
+    } else if (gain < 8 * 1024) {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 4;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x0f;
+    } else if (gain <=  16256) {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 8;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x1f;
+    } else if (gain <  32512) {
+        Dgain = 1;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x00;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    } else if (gain <  65024) {
+        Dgain = 2;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x01;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    } else if (gain < 127 * 1024) {
+        Dgain = 4;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x03;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    } else if (gain < 254 * 1024) {
+        Dgain = 8;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x07;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    } else if (gain <= SENSOR_MAXGAIN * 1024) {
+        Dgain = 16;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x0f;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+
+    if (gain <= 16256) {
+        Fine_againx64 = abs(8 * gain/ (Dgain * Ana_gain * Fine_dgainx128));
+        //Fine_dgainx128 = abs(8 * gain/ (Dgain * Ana_gain * Fine_againx64));
+        Fine_again_reg = Fine_againx64;
+        //Fine_dgain_reg = Fine_dgainx128;
+    } else {
+        Fine_dgainx128 = abs(8 * gain/ (Dgain * Ana_gain * Fine_againx64));
+        Fine_dgain_reg = Fine_dgainx128;
+    }
+
+    gain_reg[3].data = Fine_again_reg;
+    gain_reg[2].data = Ana_gain_reg;
+    gain_reg[1].data = Fine_dgain_reg;
+    gain_reg[0].data = Dgain_reg & 0x0f;
+
+    for (i = 0; i < sizeof(gain_reg)/sizeof(I2C_ARRAY); i++) {
+      if (gain_reg[i].data != gain_reg_temp[i].data) {
+        params->reg_dirty = true;
+        break;
+      }
+    }
+
+#if ENABLE_NR
+    if(reg3040 == 0x40) {
+        if (gain_reg_temp[2].data < 0x07) { // delay 1 frame group, group & exp & gain active at the same time
+            nr_reg[0].data = 0x0e;
+        } else {
+            nr_reg[0].data = 0x07;
+        }
+    } else if(reg3040 == 0x41) {
+        if (gain_reg_temp[2].data < 0x07) {
+            nr_reg[0].data = 0x0f;
+        } else {
+            nr_reg[0].data = 0x07;
+        }
+    } else {
+        nr_reg[0].data = 0x07;
+    }
+
+    /* Each frame refresh to avoid the red flash when linear and wide dynamic switching */
+    for (i = 0; i < sizeof(nr_reg)/sizeof(I2C_ARRAY); i++) {
+      if (nr_reg[i].data != nr_reg_temp[i].data) {
+        params->nr_dirty = true;
+        break;
+      }
+    }
+#endif
+
+    if (gain >= 16256)
+        temperature_reg_1[0].data = 0x07;
+    else if (gain <= 10240)
+        temperature_reg_1[0].data = 0x00;
+
+    for (i = 0; i < sizeof(temperature_reg_1)/sizeof(I2C_ARRAY); i++) {
+      if (temperature_reg_1[i].data != temperature_reg_1_temp[i].data) {
+        params->temperature_reg_1_dirty = true;
+        break;
+      }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min = 1;
+    *max = 1000000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max) {
+  *min = 1024;
+  *max = SENSOR_MAXGAIN*1024;
+  return SUCCESS;
+}
+
+static int sc2335_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = Preview_line_period;// * 3;
+    info->step = Preview_line_period/2;
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle) {
+   ms_cus_sensor *handle = drv_handle;
+    sc2335_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (sc2335_params *)handle->private_data;
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    strcpy(handle->model_id,"sc2335_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth= 1920;
+    handle->video_res_supported.res[0].nOutputHeight= 1080;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "1920x1080@30fps");
+
+
+    // i2c
+
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 2;
+    handle->ae_shutter_delay    = 2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 1;
+
+    ///calibration
+    handle->sat_mingain=g_sensor_ae_min_gain;
+
+
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init;
+
+    handle->pCus_sensor_poweron     = pCus_poweron ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = sc2335_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = sc2335_GetShutterInfo;
+    params->expo.vts=vts_30fps;
+    params->expo.fps = 30;
+    params->expo.line= 1000;
+    params->reg_dirty = false;
+    params->reg_mf = false;
+    params->nr_dirty = false;
+    return SUCCESS;
+}
+
+int cus_camsensor_release_handle(ms_cus_sensor *handle) {
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(  SC2335,
+                            cus_camsensor_init_handle_linear,
+                            NULL,
+                            NULL,
+                            sc2335_params
+                         );
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc3335_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc3335_mipi.c
new file mode 100644
index 00000000..71cc8cc2
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6b0/sensor/sensor_sc3335_mipi.c
@@ -0,0 +1,1118 @@
+/* SigmaStar trade secret */
+/* Copyright (c) [2019~2020] SigmaStar Technology.
+All rights reserved.
+
+Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+SigmaStar and be kept in strict confidence
+(SigmaStar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of SigmaStar Confidential
+Information is unlawful and strictly prohibited. SigmaStar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(SC3335);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE_LINEAR CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (2)
+//#define SENSOR_MIPI_HDR_MODE (1) //0: Non-HDR mode. 1:Sony DOL mode
+//MIPI config end.
+//============================================
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+
+//#undef SENSOR_DBG
+#define SENSOR_DBG 0
+
+#define SENSOR_ISP_TYPE     ISP_EXT                 //ISP_EXT, ISP_SOC
+#define SENSOR_IFBUS_TYPE   CUS_SENIF_BUS_MIPI     //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE PACKET_HEADER_EDGE1
+#define SENSOR_DATAPREC     CUS_DATAPRECISION_10    //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE     CUS_SEN_10TO12_9000
+#define SENSOR_BAYERID      CUS_BAYER_BG            //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_RGBIRID      CUS_RGBIR_NONE
+#define SENSOR_ORIT         CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+#define SENSOR_MAXGAIN      (15875*31875)/1000000   //max sensor gain, a-gain*conversion-gain*d-gain
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+#define long_packet_type_enable 0x00 //UD1~UD8 (user define)
+
+#define Preview_MCLK_SPEED  CUS_CMU_CLK_27MHZ        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+//#define Preview_line_period 30000                  ////HTS/PCLK=4455 pixels/148.5MHZ=30usec @MCLK=36MHz
+//#define vts_30fps 1125//1346,1616                 //for 29.1fps @ MCLK=36MHz
+//#define Line_per_second     32727
+//#define vts_30fps
+u32 Preview_line_period;
+u32 vts_30fps;
+#define Preview_WIDTH       2304                   //resolution Width when preview
+#define Preview_HEIGHT      1296                  //resolution Height when preview
+#define Preview_MAX_FPS     30  //25                     //fastest preview FPS
+#define Preview_MIN_FPS     5                       //slowest preview FPS
+#define Preview_CROP_START_X     0                      //CROP_START_X
+#define Preview_CROP_START_Y     0                      //CROP_START_Y
+
+#define SENSOR_I2C_ADDR    0x60                   //I2C slave address
+#define SENSOR_I2C_SPEED    240000                  //I2C speed,60000~320000
+
+#define SENSOR_I2C_LEGACY  I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT     I2C_FMT_A16D8        //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL     CUS_CLK_POL_NEG        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL      CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+
+#define SENSOR_VSYNC_POL    CUS_CLK_POL_NEG            // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL    CUS_CLK_POL_POS         // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL     CUS_CLK_POL_POS         // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+static int cus_camsensor_release_handle(ms_cus_sensor *handle);
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+//#define ABS(a)   ((a)>(0) ? (a) : (-(a)))
+static int g_sensor_ae_min_gain = 1024;
+#define ENABLE_NR 1
+
+CUS_MCLK_FREQ UseParaMclk(void);
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        u32 sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 line;
+    } expo;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    I2C_ARRAY tVts_reg[2];
+    I2C_ARRAY tGain_reg[4];
+    I2C_ARRAY tExpo_reg[3];
+    I2C_ARRAY tMirror_reg[1];
+    I2C_ARRAY tNr_reg[3];
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool orient_dirty;
+    bool reg_dirty;
+    bool nr_dirty;
+    CUS_CAMSENSOR_ORIT cur_orien;
+} sc3335_params;
+// set sensor ID address and data,
+
+typedef struct {
+    u64 gain;
+    u8 fine_gain_reg;
+} FINE_GAIN;
+
+const I2C_ARRAY Sensor_id_table[] =
+{
+    {0x3107, 0xcc},
+    {0x3108, 0x1a},
+};
+
+const I2C_ARRAY Sensor_init_table_3M30fps[] =
+{
+    {0x0103,0x01},
+    {0x0100,0x00},
+    {0x36e9,0x80},
+    {0x36f9,0x80},
+    {0x301f,0x01},
+    {0x3253,0x04},
+    {0x3301,0x04},
+    {0x3302,0x10},
+    {0x3304,0x40},
+    {0x3306,0x40},
+    {0x3309,0x50},
+    {0x330b,0xb6},
+    {0x330e,0x29},
+    {0x3310,0x06},
+    {0x3314,0x96},
+    {0x331e,0x39},
+    {0x331f,0x49},
+    {0x3320,0x09},
+    {0x3333,0x10},
+    {0x334c,0x01},
+    {0x3364,0x17},
+    {0x3367,0x01},
+    {0x3390,0x04},
+    {0x3391,0x08},
+    {0x3392,0x38},
+    {0x3393,0x05},
+    {0x3394,0x09},
+    {0x3395,0x16},
+    {0x33ac,0x0c},
+    {0x33ae,0x1c},
+    {0x3622,0x16},
+    {0x3637,0x22},
+    {0x363a,0x1f},
+    {0x363c,0x05},
+    {0x3670,0x0e},
+    {0x3674,0xb0},
+    {0x3675,0x88},
+    {0x3676,0x68},
+    {0x3677,0x84},
+    {0x3678,0x85},
+    {0x3679,0x86},
+    {0x367c,0x18},
+    {0x367d,0x38},
+    {0x367e,0x08},
+    {0x367f,0x18},
+    {0x3690,0x43},
+    {0x3691,0x43},
+    {0x3692,0x44},
+    {0x369c,0x18},
+    {0x369d,0x38},
+    {0x36ea,0x3b},
+    {0x36eb,0x0d},
+    {0x36ec,0x1c},
+    {0x36ed,0x24},
+    {0x36fa,0x3b},
+    {0x36fb,0x00},
+    {0x36fc,0x10},
+    {0x36fd,0x24},
+    {0x3908,0x82},
+    {0x391f,0x18},
+    {0x3e01,0xa8},
+    {0x3e02,0x20},
+    {0x3f09,0x48},
+    {0x4505,0x08},
+    {0x4509,0x20},
+    {0x5799,0x00},
+    {0x59e0,0x60},
+    {0x59e1,0x08},
+    {0x59e2,0x3f},
+    {0x59e3,0x18},
+    {0x59e4,0x18},
+    {0x59e5,0x3f},
+    {0x59e6,0x06},
+    {0x59e7,0x02},
+    {0x59e8,0x38},
+    {0x59e9,0x10},
+    {0x59ea,0x0c},
+    {0x59eb,0x10},
+    {0x59ec,0x04},
+    {0x59ed,0x02},
+    {0x36e9,0x23},
+    {0x36f9,0x23},
+    {0x0100,0x01},
+    {0xffff,0x0a},
+};
+
+I2C_ARRAY mirror_reg[] = {
+    {0x3221, 0x00}, // mirror[2:1], flip[6:5]
+};
+
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+static I2C_ARRAY gain_reg[] = {
+    {0x3e06, 0x00},
+    {0x3e07, 0x80},
+    {0x3e08, 0x00|0x03},
+    {0x3e09, 0x40}, //low bit, 0x40 - 0x7f, step 1/64
+};
+
+I2C_ARRAY expo_reg[] = {
+    {0x3e00, 0x00}, //expo [20:17]
+    {0x3e01, 0x30}, // expo[16:8]
+    {0x3e02, 0x00}, // expo[7:0], [3:0] fraction of line
+};
+
+I2C_ARRAY vts_reg[] = {
+    {0x320e, 0x05},
+    {0x320f, 0x46},
+};
+
+#if ENABLE_NR
+I2C_ARRAY nr_reg[] = {
+{0x363c,0x05},
+{0x330e,0x29},
+{0x5799,0x07},
+};
+#endif
+
+I2C_ARRAY PatternTbl[] = {
+    {0x4501,0xc8}, //testpattern , bit 3 to enable
+};
+
+CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+/*
+/////////// function definition ///////////////////
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+#define SENSOR_DMSG(args...)
+#endif
+#undef SENSOR_NAME
+#define SENSOR_NAME sc3335
+*/
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+//int cus_camsensor_release_handle(ms_cus_sensor *handle);
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);////pwd low
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+    //Sensor power on sequence
+    sensor_if->MCLK(idx, 1, handle->mclk);
+
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    //sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    //sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    //sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+    SENSOR_USLEEP(2000);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+
+    SENSOR_DMSG("[%s] pwd high\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, !handle->reset_POLARITY);
+    SENSOR_USLEEP(2000);
+
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    SENSOR_DMSG("[%s] power low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    //handle->i2c_bus->i2c_close(handle->i2c_bus);
+    SENSOR_USLEEP(1000);
+    //Set_csi_if(0, 0);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    params->cur_orien = CUS_ORIT_M0F0;
+
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+  int i,n;
+  int table_length= ARRAY_SIZE(Sensor_id_table);
+  I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+  SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+  for(n=0;n<table_length;++n) {
+    id_from_sensor[n].reg = Sensor_id_table[n].reg;
+    id_from_sensor[n].data = 0;
+  }
+
+  *id =0;
+  if(table_length>8) table_length=8;
+  for(n=0; n<4; ++n) {              //retry , until I2C success
+    if(n>2) return FAIL;
+    if(SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+        break;
+    else
+        SENSOR_USLEEP(1000);
+  }
+
+    for(i=0; i<table_length; ++i) {
+    if (id_from_sensor[i].data != Sensor_id_table[i].data)
+            return FAIL;
+    *id = ((*id)+ id_from_sensor[i].data)<<8;
+  }
+  *id >>= 8;
+    SENSOR_DMSG("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+
+    return SUCCESS;
+}
+
+static int sc3335_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+  int i;
+  SENSOR_DMSG("\n\n[%s], mode=%d \n", __FUNCTION__, mode);
+
+  switch(mode) {
+  case 1:
+    PatternTbl[0].data = 0xc8; //enable
+    break;
+  case 0:
+    PatternTbl[0].data = 0xc0; //disable
+    break;
+  default:
+    PatternTbl[0].data = 0xc0; //disable
+    break;
+  }
+  for(i=0; i< ARRAY_SIZE(PatternTbl); i++) {
+      if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+            return FAIL;
+  }
+
+  return SUCCESS;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain);
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+static int pCus_init_linear_3M30fps(ms_cus_sensor *handle)
+{
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_3M30fps);i++)
+    {
+        if(Sensor_init_table_3M30fps[i].reg==0x0100 && 0x01 == Sensor_init_table_3M30fps[i].data)
+        {
+            sensor_if->SetCSI_Clk(0, CUS_CSI_CLK_216M);
+            sensor_if->SetCSI_Lane(0, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+            sensor_if->SetCSI_LongPacketType(0, 0, 0x1C00, 0);
+            SENSOR_MSLEEP(50);
+        }
+
+        if(Sensor_init_table_3M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_3M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_3M30fps[i].reg, Sensor_init_table_3M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    params->tVts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    params->tVts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    return SUCCESS;
+}
+
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0: //"2304x1296@30fps"
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_linear_3M30fps;
+            vts_30fps=1350;//1500
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 24691;
+            break;
+
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit) {
+    char sen_data;
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    sen_data = params->tMirror_reg[0].data;
+    SENSOR_DMSG("[%s] mirror:%x\r\n", __FUNCTION__, sen_data & 0x66);
+    switch(sen_data & 0x66)
+    {
+        case 0x00:
+            *orit = CUS_ORIT_M0F0;
+            break;
+        case 0x06:
+            *orit = CUS_ORIT_M1F0;
+            break;
+        case 0x60:
+            *orit = CUS_ORIT_M0F1;
+            break;
+        case 0x66:
+            *orit = CUS_ORIT_M1F1;
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+
+    switch(orit) {
+    case CUS_ORIT_M0F0:
+    {
+        params->tMirror_reg[0].data = 0;
+        //params->tMirror_reg[1].data = 8;
+        params->orient_dirty = true;
+    }
+    break;
+    case CUS_ORIT_M1F0:
+    {
+        params->tMirror_reg[0].data = 6;
+        //params->tMirror_reg[1].data = 8;
+        params->orient_dirty = true;
+    }
+    break;
+    case CUS_ORIT_M0F1:
+    {
+        params->tMirror_reg[0].data = 0x60;
+        //params->tMirror_reg[1].data = 8;
+        params->orient_dirty = true;
+    }
+    break;
+    case CUS_ORIT_M1F1:
+    {
+        params->tMirror_reg[0].data = 0x66;
+        //params->tMirror_reg[1].data = 8;
+        params->orient_dirty = true;
+    }
+    break;
+}
+
+  SENSOR_DMSG("pCus_SetOrien:%x\r\n", orit);
+
+  return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 8) | (params->tVts_reg[1].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts=0;
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*(max_fps*1000))/fps;
+    }else{
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.line > 2 * (params->expo.vts) -8){
+        vts = (params->expo.line + 9)/2;
+    }else{
+        vts = params->expo.vts;
+    }
+    params->tVts_reg[0].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[1].data = (vts >> 0) & 0x00ff;
+    params->reg_dirty = true;
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap) {
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+        break;
+        case CUS_FRAME_ACTIVE:
+        if(params->orient_dirty)
+        {
+            SensorRegArrayW((I2C_ARRAY*)params->tMirror_reg, sizeof(mirror_reg)/sizeof(I2C_ARRAY));
+            params->orient_dirty = false;
+        }
+        if(params->reg_dirty)
+        {
+            SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, sizeof(expo_reg)/sizeof(I2C_ARRAY));
+            SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, sizeof(gain_reg)/sizeof(I2C_ARRAY));
+            SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, sizeof(vts_reg)/sizeof(I2C_ARRAY));
+            params->reg_dirty = false;
+        }
+#if ENABLE_NR
+        if(params->nr_dirty)
+        {
+            SensorReg_Write(0x3812,0x00);
+            if(params->nr_dirty)
+            {
+                SensorRegArrayW((I2C_ARRAY*)params->tNr_reg, sizeof(nr_reg)/sizeof(I2C_ARRAY));
+                params->nr_dirty = false;
+                //printk("nr_reg update --------------------- \n");
+            }
+            SensorReg_Write(0x3812,0x30);
+
+        }
+#endif
+        break;
+        default :
+        break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us) {
+    int rc=0;
+    u32 lines = 0;
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    lines |= (u32)(params->tExpo_reg[0].data&0x0f)<<16;
+    lines |= (u32)(params->tExpo_reg[1].data&0xff)<<8;
+    lines |= (u32)(params->tExpo_reg[2].data&0xf0)<<0;
+    lines >>= 4;
+    *us = (lines*Preview_line_period)/1000/2; //return us
+
+  SENSOR_DMSG("[%s] sensor expo lines/us %d, %dus\n", __FUNCTION__, lines, *us);
+  return rc;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us) {
+    int i;
+    u32 half_lines = 0,vts = 0;
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+    I2C_ARRAY expo_reg_temp[] = {  // max expo line vts-4!
+    {0x3e00, 0x00},//expo [20:17]
+    {0x3e01, 0x00}, // expo[16:8]
+    {0x3e02, 0x10}, // expo[7:0], [3:0] fraction of line
+    };
+    memcpy(expo_reg_temp, params->tExpo_reg, sizeof(expo_reg));
+
+    half_lines = (1000*us*2)/Preview_line_period; // Preview_line_period in ns
+    if(half_lines<3) half_lines=3;
+    if (half_lines >  2 * (params->expo.vts)-8) {
+        vts = (half_lines+9)/2;
+    }
+    else
+        vts=params->expo.vts;
+    params->expo.line = half_lines;
+    SENSOR_DMSG("[%s] us %ld, half_lines %ld, vts %ld\n", __FUNCTION__, us, half_lines, params->expo.vts);
+
+    half_lines = half_lines<<4;
+    params->tExpo_reg[0].data = (half_lines>>16) & 0x0f;
+    params->tExpo_reg[1].data = (half_lines>>8) & 0xff;
+    params->tExpo_reg[2].data = (half_lines>>0) & 0xf0;
+    params->tVts_reg[0].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[1].data = (vts >> 0) & 0x00ff;
+
+    for (i = 0; i < sizeof(expo_reg)/sizeof(I2C_ARRAY); i++)
+    {
+        if (params->tExpo_reg[i].data != expo_reg_temp[i].data)
+        {
+            params->reg_dirty = true;
+            break;
+        }
+    }
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain) {
+    int rc = 0;
+
+    return rc;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain) {
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain) {
+    sc3335_params *params = (sc3335_params *)handle->private_data;
+
+    u8 i=0 ,Dgain = 1,  Coarse_gain = 1;
+    u32 Fine_againx64 = 64,Fine_dgainx128 = 128;
+    u8 Dgain_reg = 0, Coarse_gain_reg = 0, Fine_again_reg= 0x10,Fine_dgain_reg= 0x80;
+
+    I2C_ARRAY gain_reg_temp[] = {
+        {0x3e06, 0x00},
+        {0x3e07, 0x80},
+        {0x3e08, (0x00|0x03)},
+        {0x3e09, 0x40},
+    };
+    I2C_ARRAY nr_reg_temp[] = {
+        {0x363c,0x05},
+        {0x330e,0x29},
+        {0x5799,0x07},
+    };
+
+    memcpy(gain_reg_temp, params->tGain_reg, sizeof(gain_reg));
+    memcpy(nr_reg_temp, params->tNr_reg, sizeof(nr_reg));
+
+    if (gain < 1024) {
+        gain = 1024;
+    } else if (gain > SENSOR_MAXGAIN*1024) {
+        gain = SENSOR_MAXGAIN*1024;
+    }
+
+    if (gain < 2 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Coarse_gain = 1;
+        Dgain_reg = 0;  Fine_dgain_reg = 0x80;  Coarse_gain_reg = 0x3;
+    }
+    else if (gain <  4 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Coarse_gain = 2;
+        Dgain_reg = 0;  Fine_dgain_reg = 0x80;  Coarse_gain_reg = 0x7;
+    }
+    else if (gain <  8 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Coarse_gain = 4;
+        Dgain_reg = 0;  Fine_dgain_reg = 0x80;  Coarse_gain_reg = 0xf;
+    }
+    else if (gain <=  16256)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Coarse_gain = 8;
+        Dgain_reg = 0;  Fine_dgain_reg = 0x80;  Coarse_gain_reg = 0x1f;
+    }
+    else if (gain <  32512)
+    {
+        Dgain = 1;      Fine_againx64 = 127;    Coarse_gain = 8;
+        Dgain_reg = 0;  Fine_again_reg = 0x7f;  Coarse_gain_reg = 0x1f;
+    }
+    else if (gain <  65024)
+    {
+        Dgain = 2;      Fine_againx64 = 127;    Coarse_gain = 8;
+        Dgain_reg = 1;  Fine_again_reg = 0x7f;  Coarse_gain_reg = 0x1f;
+    }
+    else if (gain < 127 * 1024)
+    {
+        Dgain = 4;         Fine_againx64 = 127;    Coarse_gain = 8;
+        Dgain_reg = 0x03;  Fine_again_reg = 0x7f;  Coarse_gain_reg = 0x1f;
+    }
+    else if (gain < 254 * 1024)
+    {
+        Dgain = 8;         Fine_againx64 = 127;    Coarse_gain = 8;
+        Dgain_reg = 0x07;  Fine_again_reg = 0x7f;  Coarse_gain_reg = 0x1f;
+    }
+    else if (gain <= SENSOR_MAXGAIN * 1024)
+    {
+        Dgain = 16;        Fine_againx64 = 127;    Coarse_gain = 8;
+        Dgain_reg = 0x0f;  Fine_again_reg = 0x7f;  Coarse_gain_reg = 0x1f;
+    }
+
+    if (gain <=  16256){
+        Fine_againx64 = abs(8 * gain / (Dgain * Coarse_gain * Fine_dgainx128));
+        Fine_again_reg = Fine_againx64;
+    }else{
+        Fine_dgain_reg = abs(8 * gain / (Dgain * Coarse_gain * Fine_againx64));
+    }
+
+    params->tGain_reg[3].data = Fine_again_reg;   // 9
+    params->tGain_reg[2].data = Coarse_gain_reg;  // 8
+    params->tGain_reg[1].data = Fine_dgain_reg;   // 7
+    params->tGain_reg[0].data = Dgain_reg;        // 6
+
+    for (i = 0; i < sizeof(gain_reg)/sizeof(I2C_ARRAY); i++)
+    {
+      if (params->tGain_reg[i].data != gain_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+    }
+
+#if ENABLE_NR
+    if (gain_reg_temp[2].data < 0x07) {         // gain<2
+        params->tNr_reg[0].data = 0x05;
+        params->tNr_reg[1].data = 0x29;
+    } else if (gain_reg_temp[2].data < 0x0F) {  // 2<=gain<4
+        params->tNr_reg[0].data = 0x07;
+        params->tNr_reg[1].data = 0x25;
+    } else if (gain_reg_temp[2].data < 0x1F) {  // 4<=gain<8
+        params->tNr_reg[0].data = 0x07;
+        params->tNr_reg[1].data = 0x25;
+    } else if (gain_reg_temp[2].data == 0x1F) {                                     // gain >= 8
+        params->tNr_reg[0].data = 0x07;
+        params->tNr_reg[1].data = 0x18;
+    }
+    // highTemp dpc
+    if (gain >= 16256)
+    {
+        params->tNr_reg[2].data = 0x07;
+    }
+    else if (gain <= 10240)
+    {
+        params->tNr_reg[2].data = 0x00;
+    }
+    for (i = 0; i < sizeof(nr_reg)/sizeof(I2C_ARRAY); i++)
+    {
+      if (params->tNr_reg[i].data != nr_reg_temp[i].data)
+      {
+        params->nr_dirty = true;
+        break;
+      }
+    }
+#endif
+
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min = 1;
+    *max = 1000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min = 1024;
+    *max = SENSOR_MAXGAIN*1024;
+    return SUCCESS;
+}
+
+static int sc3335_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = (Preview_line_period * 3) / 2;
+    info->step = Preview_line_period/2;
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle(ms_cus_sensor* drv_handle) {
+   ms_cus_sensor *handle = drv_handle;
+    sc3335_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (sc3335_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tMirror_reg, mirror_reg, sizeof(mirror_reg));
+    memcpy(params->tNr_reg, nr_reg, sizeof(nr_reg));
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    strcpy(handle->model_id,"sc3335_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth= 2304;
+    handle->video_res_supported.res[0].nOutputHeight= 1296;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "2304x1296@30fps");
+
+
+    // i2c
+
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 2;
+    handle->ae_shutter_delay    = 2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 1;
+
+    ///calibration
+    handle->sat_mingain=g_sensor_ae_min_gain;
+
+
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init_linear_3M30fps;
+
+    handle->pCus_sensor_poweron     = pCus_poweron ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = sc3335_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = sc3335_GetShutterInfo;
+    params->expo.vts=vts_30fps;
+    params->expo.fps = 30;
+    params->expo.line= 1000;
+    params->reg_dirty = false;
+    params->nr_dirty = false;
+
+    params->orient_dirty = false;
+
+    //handle->snr_pad_group = SENSOR_PAD_GROUP_SET;
+
+    return SUCCESS;
+}
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+SENSOR_DRV_ENTRY_IMPL_END_EX( SC3335,
+                            cus_camsensor_init_handle,
+                            NULL,
+                            NULL,
+                            sc3335_params
+                         );
+
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/Makefile b/general/package/sigmastar-osdrv-sensor/src/infinity6e/Makefile
new file mode 100644
index 00000000..b18f8982
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/Makefile
@@ -0,0 +1,9 @@
+EXTRA_CFLAGS += -I $(PWD)/include -I $(KSRC)/drivers/sstar/include
+EXTRA_CFLAGS += -D SENSOR_MODULE_VERSION=$(OPENIPC_SOC_MODEL)-$(OPENIPC_SOC_FAMILY)
+obj-m := $(patsubst $(PWD)/%.c, %.o, $(wildcard $(PWD)/sensor/*.c))
+
+modules:
+	$(MAKE) -C $(KSRC) M=$(PWD) modules
+
+clean:
+	$(MAKE) -C $(KSRC) M=$(PWD) clean
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_ms_cus_sensor.h b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_ms_cus_sensor.h
new file mode 100644
index 00000000..b4929f1b
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_ms_cus_sensor.h
@@ -0,0 +1,1045 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+/*! @file drv_ms_cus_sensor.h
+      @brief This file contains Infinity ISP sensor driver interface.
+*/
+
+/** @defgroup group1 ISP Sensor Driver Interface
+* @{
+*/
+
+#ifndef DRV_MS_CUS_SENSOR_H_
+#define DRV_MS_CUS_SENSOR_H_
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <sensor_i2c_api.h>
+
+#define I2C_RETRYTIME (5)
+
+#ifndef SUCCESS
+#define FAIL        (-1)
+#define SUCCESS     0
+#endif
+
+#ifdef __cplusplus
+#define EXPORT_CUS  extern "C"
+#else
+#define EXPORT_CUS
+#endif
+
+#define CUS_CAMSENSOR_HANDLE_MAJ_VER 0x0002
+#define CUS_CAMSENSOR_HANDLE_MIN_VER 0x0002
+
+#define CUS_CAMSENSORIF_MAJ_VER 0x0001
+#define CUS_CAMSENSORIF_MIN_VER 0x0002
+
+#define CUS_CAMSENSOR_I2C_MAJ_VER 0x0001
+#define CUS_CAMSENSOR_I2C_MIN_VER 0x0001
+
+#define CUS_MSTART_CAMSENSOR_CAP_VERSION 0x0001
+
+//#define usleep(usec)  CamOsMsSleep(usec*1000);
+//#define usleep(usec)  udelay(usec)
+//#define ARRAY_SIZE(a) (sizeof(a)/sizeof(a[0]))
+
+#define SENSOR_DRIVER_MODE_NOT_SUUPORT                          (0xFFFF)
+
+struct __ms_cus_sensor; /**< Sensor driver handle */
+//struct __ISensorAPI; /**< Sensor to ISP control interface */
+
+/*! @brief Resolution descriptor*/
+typedef struct _cus_camsensor_res{
+    u32 width;      /**< Image crop width */
+    u32 height;     /**< Image crop height */
+    u32 max_fps; /**< Max fps in this resolution */
+    u32 min_fps;  /**< Min fps in this resolution*/
+    u32 crop_start_x;
+    u32 crop_start_y;
+    u32 nOutputWidth; /**< Sensor actual output width */
+    u32 nOutputHeight; /**< Sensor actual output height */
+    char strResDesc[32];
+    u32 nMinFrameLengthLine;    // in Line
+    u32 nRowTime;
+} __attribute__((packed, aligned(4))) cus_camsensor_res;
+
+/*! @brief Resolution list*/
+typedef struct _cus_camsensor_res_list
+{
+    u32 num_res;                        /**< number of sensor resolution in list */
+    u32 ulcur_res;                        /**< current sensor resolution*/
+    cus_camsensor_res res[12];      /**< resolution list */
+} __attribute__((packed, aligned(4))) cus_camsensor_res_list;
+
+
+/*! @brief Select sensor type */
+typedef enum {
+    ISP_SOC,                /**< Not support */
+    ISP_EXT                 /**< sensor without built-in ISP */
+} CUS_CAMSENSOR_ISPTYPE;
+
+/*! @brief Sensor bayer raw pixel order */
+typedef enum {
+    CUS_BAYER_RG = 0,       /**< bayer data start with R channel */
+    CUS_BAYER_GR,             /**<  bayer data start with Gr channel */
+    CUS_BAYER_BG,             /**<  bayer data start with B channel */
+    CUS_BAYER_GB              /**<  bayer data start with Gb channel */
+} CUS_SEN_BAYER;
+
+typedef enum {
+    CUS_RGBIR_NONE = 0, /** modify RGBIR pixel order enumeration */
+    CUS_RGBIR_R0 = 1,
+    CUS_RGBIR_G0 = 2,
+    CUS_RGBIR_B0 = 3,
+    CUS_RGBIR_G1 = 4,
+    CUS_RGBIR_G2 = 5,
+    CUS_RGBIR_I0 = 6,
+    CUS_RGBIR_G3 = 7,
+    CUS_RGBIR_I1 = 8
+} CUS_SEN_RGBIR;
+
+/*! @brief Set sensor image mirror and flip.*/
+typedef enum {
+    CUS_ORIT_M0F0,                  /**< mirror, flip unchanged */
+    CUS_ORIT_M1F0,                  /**< mirror changed, flip unchanged */
+    CUS_ORIT_M0F1,                  /**< mirror unchanged, flip changed */
+    CUS_ORIT_M1F1,                  /**< mirror and flip changed */
+} CUS_CAMSENSOR_ORIT;
+
+
+/*! @brief Get input source type.*/
+typedef enum {
+    CUS_SNR_ANADEC_SRC_NO_READY,    /**< input no ready */
+    CUS_SNR_ANADEC_SRC_DISCNT,      /**< input disconnect */
+    CUS_SNR_ANADEC_SRC_PAL,         /**< input type is PAL */
+    CUS_SNR_ANADEC_SRC_NTSC,        /**< input type is NTSC */
+    CUS_SNR_ANADEC_SRC_HD_25P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_HD_30P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_HD_50P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_HD_60P,      /**< input source type is HD */
+    CUS_SNR_ANADEC_SRC_FHD_25P,     /**< input source type is FHD */
+    CUS_SNR_ANADEC_SRC_FHD_30P,     /**< input source type is FHD */
+}CUS_SNR_ANADEC_SRC_TYPE;
+
+
+/*! @brief ISP AE event notifycation*/
+typedef enum {
+    CUS_FRAME_INACTIVE = 0, /**< Frame end */
+    CUS_FRAME_ACTIVE = 1,/**< Frame start */
+} CUS_CAMSENSOR_AE_STATUS_NOTIFY;
+
+/*! @brief Sensor bayer raw (8/10 bits) to 12bits mode control */
+typedef enum {
+    CUS_SEN_8TO12_7074,       /**< Do not use*/
+    CUS_SEN_8TO12_7000,       /**< Sensor bayer raw is 8 bits*/
+    CUS_SEN_8TO12_114118,   /**< Do not use*/
+    CUS_SEN_8TO12_11400,     /**< Do not use*/
+    CUS_SEN_10TO12_9098,     /**< Do not use*/
+    CUS_SEN_10TO12_9000,     /**< Sensor bayer raw is 10 bits*/
+    CUS_SEN_10TO12_1121110, /**< Do not use*/
+    CUS_SEN_10TO12_11200    /**< Do not use*/
+} CUS_SEN_FMT_CONV_MODE;
+
+/*! @brief Sensor input raw data precision */
+typedef enum {
+    CUS_DATAPRECISION_8 = 0,    /**< raw data precision is 8bits */
+    CUS_DATAPRECISION_10 = 1,   /**< raw data precision is 10bits */
+    CUS_DATAPRECISION_16 = 2,    /**< raw data precision is 16bits */
+    CUS_DATAPRECISION_12 = 3,   /**< raw data precision is 12bits */
+    CUS_DATAPRECISION_14 = 4,   /**< raw data precision is 14bits */
+} CUS_DATAPRECISION;
+
+/*! @brief Select sensor data intarface */
+typedef enum {
+    CUS_SENIF_BUS_PARL = 0, /**< sensor data bus is parallel bus */
+    CUS_SENIF_BUS_MIPI = 1,  /**<  sensor data bus is mipi */
+    CUS_SENIF_BUS_BT601 = 2,
+    CUS_SENIF_BUS_BT656 = 3,
+    CUS_SENIF_BUS_BT1120 = 4,
+} CUS_SENIF_BUS;
+
+typedef enum {
+    CUS_SEN_INPUT_FORMAT_YUV422,
+    CUS_SEN_INPUT_FORMAT_RGB,
+} CUS_SEN_INPUT_FORMAT;
+
+/*! @brief Select pin polarity */
+typedef enum {
+    CUS_CLK_POL_POS = 0,    /**< High active */
+    CUS_CLK_POL_NEG         /**< Low active */
+} CUS_CLK_POL;
+
+typedef enum
+{
+    CUS_SENSOR_YUV_ORDER_CY = 0,
+    CUS_SENSOR_YUV_ORDER_YC = 1,
+}CUS_SENSOR_YUV_ORDER;
+
+/*! @brief Sensor master clock select */
+typedef enum {
+    CUS_CMU_CLK_27MHZ,
+    CUS_CMU_CLK_21P6MHZ,
+    CUS_CMU_CLK_12MHZ,
+    CUS_CMU_CLK_5P4MHZ,
+    CUS_CMU_CLK_36MHZ,
+    CUS_CMU_CLK_54MHZ,
+    CUS_CMU_CLK_43P2MHZ,
+    CUS_CMU_CLK_61P7MHZ,
+    CUS_CMU_CLK_72MHZ,
+    CUS_CMU_CLK_48MHZ,
+    CUS_CMU_CLK_24MHZ,
+    CUS_CMU_CLK_37P125MHZ,
+    CUS_CMU_CLK_LPLL_DIV1,
+    CUS_CMU_CLK_LPLL_DIV2,
+    CUS_CMU_CLK_LPLL_DIV4,
+    CUS_CMU_CLK_LPLL_DIV8,
+} CUS_MCLK_FREQ; //Depends on chip.
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_PAR_DISABLE,
+    CUS_SR0_PAR_MODE_1,
+    CUS_SR0_PAR_MODE_2,
+} CUS_SR0_PAR_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_BT656_DISABLE,
+    CUS_SR0_BT656_MODE_1,
+    CUS_SR0_BT656_MODE_2,
+    CUS_SR0_BT656_MODE_3,
+    CUS_SR0_BT656_MODE_4,
+} CUS_SR0_BT656_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR1_BT656_DISABLE,
+    CUS_SR1_BT656_MODE_1,
+} CUS_SR1_BT656_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_BT601_DISABLE,
+    CUS_SR0_BT601_MODE_1,
+    CUS_SR0_BT601_MODE_2,
+    CUS_SR0_BT601_MODE_3,
+    CUS_SR0_BT601_MODE_4,
+} CUS_SR0_BT601_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR0_MIPI_DISABLE,
+    CUS_SR0_MIPI_MODE_1,
+    CUS_SR0_MIPI_MODE_2,
+} CUS_SR0_MIPI_MODE;
+
+//Depends on chip definition.
+typedef enum {
+    CUS_SR1_MIPI_DISABLE,
+    CUS_SR1_MIPI_MODE_1,
+    CUS_SR1_MIPI_MODE_2,
+    CUS_SR1_MIPI_MODE_3,
+    CUS_SR1_MIPI_MODE_4,
+} CUS_SR1_MIPI_MODE;
+
+//Depends on chip definition.
+typedef enum
+{
+    CUS_VIF_BT656_EAV_DETECT = 0,
+    CUS_VIF_BT656_SAV_DETECT = 1,
+}CUS_VIF_BT656_CHANNEL_SELECT;
+
+//Depends on chip definition.
+typedef enum
+{
+    CUS_VIF_BT656_VSYNC_DELAY_1LINE = 0,
+    CUS_VIF_BT656_VSYNC_DELAY_2LINE = 1,
+    CUS_VIF_BT656_VSYNC_DELAY_0LINE = 2,
+    CUS_VIF_BT656_VSYNC_DELAY_AUTO = 3,
+}CUS_VIF_BT656_VSYNC_DELAY;
+
+typedef enum
+{
+    CUS_SENSOR_FUNC_DISABLE = 0,
+    CUS_SENSOR_FUNC_ENABLE = 1,
+}CUS_SENSOR_FUNC;
+
+typedef enum
+{
+    CUS_SENSOR_PAD_GROUP_A = 0,
+    CUS_SENSOR_PAD_GROUP_B = 1,
+    CUS_SENSOR_PAD_GROUP_C = 2,
+    CUS_SENSOR_PAD_GROUP_D = 3,
+}CUS_SENSOR_PAD_GROUP;
+
+typedef enum
+{
+    CUS_SENSOR_MASTER_MODE = 0,
+    CUS_SENSOR_SLAVE_MODE = 1,
+}CUS_SENSOR_MODE;
+
+typedef enum
+{
+    CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL = 0,
+    CUS_SENSOR_CHANNEL_MODE_REALTIME_HDR = 1,
+    CUS_SENSOR_CHANNEL_MODE_RAW_STORE = 2,
+    CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR = 3,
+}CUS_SENSOR_CHANNEL_MODE;
+
+typedef struct {
+    unsigned int gain;
+    unsigned int offset;
+} CUS_GAIN_GAP_ARRAY;
+
+//////////////////////////////////////
+// sensor functions
+//////////////////////////////////////
+
+typedef struct {
+    u32 length;     //header length
+    u32 version;         //version
+}CUS_CAMSENSOR_CAP;
+
+/////////////////// ISP for SENSOR API ///////////////////
+typedef enum {
+    CUS_INT_TASK_AE     = (1<<0),
+    CUS_INT_TASK_AWB    = (1<<1),
+    CUS_INT_TASK_AF     = (1<<2),
+    CUS_INT_TASK_VS     = (1<<3),
+    CUS_INT_TASK_VDOS   = (1<<4),
+} CUS_INT_TASK_TYPE;
+
+#define MAX_RUN_ORDER 16
+typedef struct {
+    u8 RunLength;
+    u8 Orders[MAX_RUN_ORDER];
+    u8 CurTaskType;
+} CUS_INT_TASK_ORDER;
+
+/////////////////// Shutter Info ///////////////////////
+/*! @brief Report shutter information */
+typedef struct {
+    u32 length;    /**< struct size */
+    u32 max;       /**< maximun shutter in us*/
+    u32 min;        /**< minimum shutter in us*/
+    u32 step;       /**< shutter in step us*/
+} CUS_SHUTTER_INFO;
+
+////////////////// CSI CLOCK ////////////////////////
+/*! @brief Select MIPI clock*/
+typedef enum {
+    CUS_CSI_CLK_DISABLE = -1, /**< Disable MIPI clock*/
+    CUS_CSI_CLK_108M = 0,    /**< MIPI pixel rate 864Mbps (1-lane)*/
+    CUS_CSI_CLK_86M = 1, /**< MIPI pixel rate 344Mbps(1-lane)*/
+    CUS_CSI_CLK_144M = 2, /**< MIPI pixel rate 1152Mbps(1-lane)*/
+    CUS_CSI_CLK_172M = 3,
+    CUS_CSI_CLK_216M = 4,
+    CUS_CSI_CLK_288M = 5,
+    CUS_CSI_CLK_40M = 6,
+    CUS_CSI_CLK_24M = 7,
+    CUS_CSI_CLK_12M = 8,
+    CUS_CSI_CLK_123M = 9
+}CUS_CSI_CLK;
+
+///////////////// SENSOR PIN CONFIG/////////////////
+/*! @brief Sensor pin assignment*/
+typedef enum {
+    CUS_SR_PAD_CFG_1 = 1,       /**< Pin config for MIPI 1/2 lanes*/
+    CUS_SR_PAD_CFG_MIPI = 1,  /**< Pin config for  MIPI 1/2 lanes*/
+    CUS_SR_PAD_CFG_2 = 2,       /**< Reserved */
+    CUS_SR_PAD_CFG_3 = 3,       /**< Reserved */
+    CUS_SR_PAD_CFG_10BITS = 4,    /**< Pin config for parallel interface 10 bits */
+    CUS_SR_PAD_CFG_4 = 4,        /**< Pin config for parallel interface 12 bits */
+    CUS_SR_PAD_CFG_12BITS = 5,  /**< Pin config for parallel interface 12 bits */
+    CUS_SR_PAD_CFG_5 = 5,       /**< Pin config for parallel interface 12 bits */
+    CUS_SR_PAD_CFG_6 = 6       /**< Pin config for parallel interface 12 bits */
+ }CUS_SR_PAD_CFG;
+
+/*! @brief virtual channel0 hsync. mode */
+typedef enum
+{
+    PACKET_HEADER_EDGE1 = 0,    /**< packet header edge */
+    PACKET_HEADER_EDGE2 = 1,    /**< line end edge */
+    PACKET_HEADER_EDGE3 = 2,    /**< line start edge */
+    PACKET_FOOTER_EDGE = 3,      /**< packet footer edge */
+}CUS_CSI_VC_HS_MODE;
+
+typedef enum
+{
+    CUS_HDR_MODE_NONE = 0,
+    CUS_HDR_MODE_SONY_DOL = 1,
+    CUS_HDR_MODE_DCG = 2,
+    CUS_HDR_MODE_EMBEDDED_RAW8 = 3,
+    CUS_HDR_MODE_EMBEDDED_RAW10 = 4,
+    CUS_HDR_MODE_EMBEDDED_RAW12 = 5,
+    CUS_HDR_MODE_EMBEDDED_RAW16 = 6, //Only for OV2718?
+    CUS_HDR_MODE_LI = 7,
+    CUS_HDR_MODE_MULTI_VC = 8,
+}CUS_HDR_MODE;
+
+typedef enum
+{
+    // Index 0
+    SENSOR_DRIVER_MODE_VGA_30P_RESOLUTION,                    // 640*360 30P
+    SENSOR_DRIVER_MODE_VGA_50P_RESOLUTION,                    // 640*360 50P
+    SENSOR_DRIVER_MODE_VGA_60P_RESOLUTION,                    // 640*360 60P
+    SENSOR_DRIVER_MODE_VGA_100P_RESOLUTION,                   // 640*360 100P
+    SENSOR_DRIVER_MODE_VGA_120P_RESOLUTION,                   // 640*360 120P
+
+    // Index 5
+    SENSOR_DRIVER_MODE_HD_24P_RESOLUTION,                     // 1280*720 24P
+    SENSOR_DRIVER_MODE_HD_30P_RESOLUTION,                     // 1280*720 30P
+    SENSOR_DRIVER_MODE_HD_50P_RESOLUTION,                     // 1280*720 50P
+    SENSOR_DRIVER_MODE_HD_60P_RESOLUTION,                     // 1280*720 60P
+    SENSOR_DRIVER_MODE_HD_100P_RESOLUTION,                    // 1280*720 100P
+
+    // Index 10
+    SENSOR_DRIVER_MODE_HD_120P_RESOLUTION,                    // 1280*720 120P
+    SENSOR_DRIVER_MODE_1600x900_30P_RESOLUTION,               // 1600*900 30P
+    SENSOR_DRIVER_MODE_FULL_HD_15P_RESOLUTION,                // 1920*1080 15P
+    SENSOR_DRIVER_MODE_FULL_HD_24P_RESOLUTION,                // 1920*1080 24P
+    SENSOR_DRIVER_MODE_FULL_HD_25P_RESOLUTION,                // 1920*1080 25P
+
+    // Index 15
+    SENSOR_DRIVER_MODE_FULL_HD_30P_RESOLUTION,                // 1920*1080 30P
+    SENSOR_DRIVER_MODE_FULL_HD_50P_RESOLUTION,                // 1920*1080 50P
+    SENSOR_DRIVER_MODE_FULL_HD_60P_RESOLUTION,                // 1920*1080 60P
+    SENSOR_DRIVER_MODE_SUPER_HD_30P_RESOLUTION,               // 2304*1296 30P
+    SENSOR_DRIVER_MODE_SUPER_HD_25P_RESOLUTION,               // 2304*1296 25P
+
+    // Index 20
+    SENSOR_DRIVER_MODE_SUPER_HD_24P_RESOLUTION,               // 2304*1296 24P
+    SENSOR_DRIVER_MODE_1440_30P_RESOLUTION,                   // 2560*1440 30P
+    SENSOR_DRIVER_MODE_2D7K_15P_RESOLUTION,                   // 2704*1524 15P
+    SENSOR_DRIVER_MODE_2D7K_30P_RESOLUTION,                   // 2704*1524 30P
+    SENSOR_DRIVER_MODE_4K2K_15P_RESOLUTION,                   // 3840*2160 15P
+
+    // Index 25
+    SENSOR_DRIVER_MODE_4K2K_30P_RESOLUTION,                   // 3840*2160 30P
+    SENSOR_DRIVER_MODE_4TO3_VGA_30P_RESOLUTION,               // 640*480   30P
+    SENSOR_DRIVER_MODE_4TO3_1D2M_30P_RESOLUTION,              // 1280*960  30P
+    SENSOR_DRIVER_MODE_4TO3_1D5M_30P_RESOLUTION,              // 1440*1080 30P
+    SENSOR_DRIVER_MODE_4TO3_3M_15P_RESOLUTION,                // 2048*1536 15P
+
+    // Index 30
+    SENSOR_DRIVER_MODE_4TO3_3M_30P_RESOLUTION,                // 2048*1536 30P
+    SENSOR_DRIVER_MODE_4TO3_5M_15P_RESOLUTION,                // 2560*1920 15P
+    SENSOR_DRIVER_MODE_4TO3_5M_30P_RESOLUTION,                // 2560*1920 30P
+    SENSOR_DRIVER_MODE_4TO3_8M_15P_RESOLUTION,                // 3264*2448 15P
+    SENSOR_DRIVER_MODE_4TO3_8M_30P_RESOLUTION,                // 3264*2448 30P
+
+    // Index 35
+    SENSOR_DRIVER_MODE_4TO3_10M_15P_RESOLUTION,               // 3648*2736 15P
+    SENSOR_DRIVER_MODE_4TO3_10M_30P_RESOLUTION,               // 3648*2736 30P
+    SENSOR_DRIVER_MODE_4TO3_12M_15P_RESOLUTION,               // 4032*3024 15P
+    SENSOR_DRIVER_MODE_4TO3_12M_30P_RESOLUTION,               // 4032*3024 30P
+    SENSOR_DRIVER_MODE_4TO3_14M_15P_RESOLUTION,               // 4352*3264 15P
+
+    // Index 40
+    SENSOR_DRIVER_MODE_4TO3_14M_30P_RESOLUTION,               // 4352*3264 30P
+    SENSOR_DRIVER_MODE_4K2K_24P_RESOLUTION,
+    SENSOR_DRIVER_MODE_PAL_25P_RESOLUTION,
+    SENSOR_DRIVER_MODE_NTSC_30P_RESOLUTION,
+
+    // For Camera Preview
+    SENSOR_DRIVER_MODE_BEST_CAMERA_PREVIEW_RESOLUTION,
+    SENSOR_DRIVER_MODE_BEST_CAMERA_CAPTURE_16TO9_RESOLUTION,
+    SENSOR_DRIVER_MODE_BEST_CAMERA_CAPTURE_4TO3_RESOLUTION,
+    SENSOR_DRIVER_MODE_FULL_HD_30P_RESOLUTION_HDR,
+} CUS_SNR_RESOLUTION;
+
+
+#ifdef __cplusplus
+extern "C"
+#endif
+
+/**@brief ISP sensor interface control API */
+typedef struct __ISensorIfAPI //isp sensor interface API
+{
+    version_info version;
+    /**@brief Reserved */
+    void* pdata;
+
+    /** @brief Set sensor power down pin.
+    @param[in] idx Sensor pad ID.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*PowerOff)(u32 idx, CUS_CLK_POL pol);
+
+    /** @brief Set sensor power reset pin.
+    @param[in] idx Sensor pad ID.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*Reset)(u32 idx, CUS_CLK_POL pol);
+
+    /** @brief Configure sensor master clock.
+    @param[in] idx Sensor pad ID.
+    @param[in] bONOFF Clock ON/OFF control.
+    @param[in] mclk Clock frequency Hz.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*MCLK)(u32 idx, u8 bONOFF, CUS_MCLK_FREQ mclk);
+
+    /** @brief Query sensor master clock.
+    @param[in] idx Sensor pad ID.
+    @param[in] mclk Query if clock frequency Hz is available.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*QueryMCLK)(u32 idx, CUS_MCLK_FREQ mclk);
+
+    /** @brief Query MIPI lane number.
+    @param[in] idx Sensor pad ID.
+    @param[in] lane_num Query max lane number.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*QueryLaneNum)(u32 idx, u8 *max_lane);
+#if 0
+    /** @brief Select pixel clock source
+    @remarks Parallel interface only
+    @param[in] handle Handle to sensor driver.
+    @param[in] pclk_source Clock source.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*PCLK)(CUS_PCLK_SOURCE pclk_source);        //senect sensor
+
+    /** @brief Configure HSYNC pin polarity.
+    @remarks Parallel interface only
+    @param[in] handle Handle to sensor driver.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*HsyncPol)(CUS_CLK_POL pol);
+
+    /** @brief [parallel interface only] Configure VSYNC pin polarity.
+    @param[in] handle Handle to sensor driver.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*VsyncPol)(CUS_CLK_POL pol);
+
+    /** @brief Configure PCLK pin polarity.
+    @param[in] handle Handle to sensor driver.
+    @param[in] pol pin polarity.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*ClkPol)(CUS_CLK_POL pol);
+
+    /** @brief Configure sensor bayer raw pixel order
+    @param[in] handle Handle to sensor driver.
+    @param[in] bayer_id Select pixel order
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*BayerFmt)(CUS_SEN_BAYER bayer_id);
+
+    /** @brief Configure sensor RGBIR (8 or 10bits) convert to 12bit bits isp input, This config will be ignore for 12/16 bits sensor bayer raw input.
+    @param[in] handle Handle to sensor driver.
+    @param[in] mode Mode select
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*FmtConv)(CUS_SEN_FMT_CONV_MODE mode);
+
+    /** @brief Select sensor image data interface
+    @param[in] handle Handle to sensor driver.
+    @param[in] bus Sensor interface
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*DataBus)(CUS_SENIF_BUS bus);
+
+    /** @brief Configure sensor bayer raw pixel bits
+    @param[in] handle Handle to sensor driver.
+    @param[in] prec Select pixel bits
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*DataPrecision)(CUS_DATAPRECISION prec);
+
+    /** @brief Wait isp frame start event
+    @param[in] handle Handle to sensor driver.
+    @param[in] ms Max timeout in ms
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*WaitVStart)(int ms);
+
+    /** @brief Wait isp frame end event
+    @param[in] handle Handle to sensor driver.
+    @param[in] ms Max timeout in ms
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*WaitVEnd)(int ms);
+
+    /** @brief Configure 3A task order table
+    @param[in] handle Handle to sensor driver.
+    @param[in] tasks Task order table
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*Set3ATaskOrder)(CUS_INT_TASK_ORDER tasks);
+#endif
+    /** @brief Select sensor IO pin assignment
+    @param[in] idx Sensor pad ID.
+    @param[in] ulSnrType Interface type.
+    @param[in] ulSnrPadCfg Pin config.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetIOPad)(u32 idx, CUS_SENIF_BUS ulSnrType, u32 ulSnrPadCfg);
+
+    //FOR CSI
+
+    /** @brief Set maximum mipi data rate (amount of all lans)
+    @remarks MIPI interface only.
+    @param[in] idx Sensor pad ID.
+    @param[in] clk Max data rate.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_Clk)(u32 idx, CUS_CSI_CLK clk);
+
+    /** @brief Set number of MIPI lanes
+    @remarks MIPI interface only.
+    @param[in] idx Sensor pad ID.
+    @param[in] num_lan Number of lanes.
+    @param[in] bon_off Clock ON/OFF control.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_Lane)(u32 idx, u16 num_lan, u8 bon_off);
+
+    /** @brief Enable long packet type
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] ctl_cfg0_15 Control flag bit[0:15]
+    @param[in] ctl_cfg16_31 Control flag bit[16:31]
+    @param[in] ctl_cfg32_47 Control flag bit[32:47]
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_LongPacketType)(u32 idx, u16 ctl_cfg0_15, u16 ctl_cfg16_31, u16 ctl_cfg32_47);
+
+    /** @brief Virtual channel0 hsync mode
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] mode HSYNC mode.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_VC0HSmode)(CUS_CSI_VC_HS_MODE mode);
+
+    /** @brief Configure MIPI capture start timing
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] rx_clk_skip_ns
+    @param[in] rx_data_skip_ns
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_clk_data_skip)(u32 idx, u8 rx_clk_skip_ns,u8 rx_data_skip_ns);
+
+    /** @brief Configure MIPI hdr mode
+    @remarks MIPI interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] hdr_mode HDR mode.
+    @param[in] bon_off Clock ON/OFF control.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetCSI_hdr_mode)(u32 idx, CUS_HDR_MODE hdr_mode, u8 bon_off);
+
+#if 0
+    /** @brief Configure sensor RGBIR raw pixel order
+    @param[in] handle Handle to sensor driver.
+    @param[in] bayer_id Select pixel order
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*RGBIRFmt)(CUS_SEN_RGBIR RGBIR_id);
+#endif
+
+    /** @brief Skip vif output frame
+    @remarks Skip Frame interface only
+    @param[in] idx Sensor pad ID.
+    @param[in] fps Sensor current fps.
+    @param[in] cnt Skip counter
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetSkipFrame)(u32 idx, u32 fps, u32  cnt);
+
+    /** @brief Switch Vif PadID
+    @remarks Switch Vif PadID mux
+    @param[in] id Vif Select Source.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*SetVIFSelectSource)(u32 id); ///2eff
+
+}ISensorIfAPI;
+
+typedef union {
+    //Parallel sensor
+    struct {
+        u32 parallel_reserved; //No additional attribute.
+    } attr_parallel;
+
+    //MIPI sensor
+    struct {
+        u32 mipi_lane_num;
+        u32 mipi_data_format; //0: YUV 422 format. 1: RGB pattern.
+        u32 mipi_yuv_order; //YUYV or UYVY
+        u32 mipi_hsync_mode;
+        u32 mipi_sampling_delay; /** < MIPI start sampling delay */ /*bit 0~7: clk_skip_ns. bit 8~15: data_skip_ns*/
+        CUS_HDR_MODE mipi_hdr_mode;
+        u32 mipi_hdr_virtual_channel_num;
+    } attr_mipi;
+
+    //BT656 sensor
+    struct {
+        u32 bt656_total_ch;
+        u32 bt656_cur_ch;
+        u32 bt656_ch_det_en;
+        CUS_VIF_BT656_CHANNEL_SELECT bt656_ch_det_sel;
+        u32 bt656_bit_swap;
+        u32 bt656_8bit_mode;
+        CUS_VIF_BT656_VSYNC_DELAY bt656_vsync_delay;
+        u32 bt656_hsync_inv;
+        u32 bt656_vsync_inv;
+        u32 bt656_clamp_en;
+        u32 bt656_yuv_order; //YUYV or UYVY
+    } attr_bt656;
+}  InterfaceAttr_u;
+
+///////////////////////////////////////////////////////
+
+/** @brief Sensor driver interface \n
+The function here are implemented by sensor driver.
+*/
+typedef struct __ms_cus_sensor{
+    //short     lib_idx;      /**< Reserved , Do not use */
+    version_info version;
+    char model_id[32];      /**< Please fill the sensor modle id string here then libcamera user can read model_id by using cameraGetSensorModelID() .*/
+    void *sen_handle;       /**< Reserved , Do not use */
+    void *private_data;     /**< sensor driver dependent variables should store in private_data and free when release */
+    void *slave_mode_set;   /**< Reserved , For sensor vsync/hsync control*/
+
+    // i2c
+    app_i2c_cfg i2c_cfg;           /**< Sensor i2c setting */
+    i2c_handle_t *i2c_bus;         /**< Handle to sensor i2c API. */
+
+    // sensor if api
+    ISensorIfAPI *sensor_if_api;   /**< sensor interface API */
+
+    // ae parameters
+    int ae_gain_delay;      /**< How many frame delay from writing AE gain to take effect*/
+    int ae_shutter_delay;   /**< How many frame delay from writing AE shutter to take effect*/
+    int ae_gain_ctrl_num;
+    int ae_shutter_ctrl_num;
+
+    // polarity
+    CUS_CLK_POL reset_POLARITY;   /** < Sensor REST pin polarity */
+    CUS_CLK_POL pwdn_POLARITY;    /** < Sensor Power Down pin polarity */
+    CUS_CLK_POL VSYNC_POLARITY;   /** < Sensor VSYNC polarity */
+    CUS_CLK_POL HSYNC_POLARITY;   /** < Sensor HSYNC pin polarity */
+    CUS_CLK_POL PCLK_POLARITY;    /** < Sensor Plxel Clock pin polarity */
+
+    // sensor data enum list*/
+    CUS_CAMSENSOR_ISPTYPE   isp_type;    /** < Always use ISP_EXT */
+    CUS_SEN_BAYER           bayer_id;    /** < Sensor bayer raw pixel order */
+    CUS_SEN_RGBIR           RGBIR_id;    /** < Sensor bayer raw pixel order */
+    CUS_SENIF_BUS           sif_bus;     /** < Select sensor interface */
+    CUS_DATAPRECISION       data_prec;   /** < Raw data bits */
+    CUS_SEN_FMT_CONV_MODE   data_mode;   /** < Data convert mode*/
+    CUS_CAMSENSOR_ORIT      orient;      /** < Sensor mirror/flip */
+    CUS_SENSOR_PAD_GROUP    snr_pad_group;
+    CUS_SENSOR_MODE         snr_pad_mode;       /** < support master/slave mode sensor */
+
+    cus_camsensor_res_list  video_res_supported; /** < Resolution list */
+    InterfaceAttr_u         interface_attr;
+
+   //sensor calibration
+    u32                     mclk;        /** < Sensor master clock frequency */
+    u32                     sat_mingain;    /**< Minimum AE gain */
+    u32                     ir_only_fmt;
+    u32                     nPixelSize;           //in nano meter
+
+    ////////////////////////////////////////////////
+    // system functions
+    ////////////////////////////////////////////////
+
+    /** @brief Sensor power on sequence, I2C must be ready after calling this function
+    @param[in] handle Handle to sensor driver.
+    @remark Following configuration need to set up at this stage \n
+    @ref __ISensorIfAPI::Reset Reset sensor \n
+    @ref __ISensorIfAPI::PowerOff Sensor power down pin \n
+    @ref __ISensorIfAPI::MCLK Sensor master clock \n
+    @ref __ISensorIfAPI::SetIOPad ISP sensor IO \n
+    @ref __ISensorIfAPI::SetCSI_Clk  [MIPI sensor only] MIPI clock\n
+    @ref __ISensorIfAPI::HsyncPol Hsync polarity\n
+    @ref __ISensorIfAPI::VsyncPol Vsync polarity\n
+    @ref __ISensorIfAPI::ClkPol [Parallel sensor only]  Pixel clock polarity\n
+    @ref __ISensorIfAPI::BayerFmt Raw data format\n
+    @ref __ISensorIfAPI::DataPrecision Raw data pixel bits\n
+    @ref __ISensorIfAPI::FmtConv Raw data to ISP pixel convert\n
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_poweron)(struct __ms_cus_sensor* handle, u32 idx);
+
+    /** @brief Sensor power off
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_poweroff)(struct __ms_cus_sensor* handle, u32 idx);
+
+    /** @brief Sensor initialization
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark Fill sensor initial table here, Sensor beginning to output raw images after calling this function .
+    */
+    int (*pCus_sensor_init)(struct __ms_cus_sensor* handle);
+
+    /** @brief Sensor Post initialization
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark Fill sensor initial table here, Sensor beginning to output raw images after calling this function .
+    */
+    int (*pCus_sensor_post_init)(struct __ms_cus_sensor* handle, u32 idx);
+
+    /** @brief Release resources those allocated in cus_camsensor_init_handle()
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark Release resource allocated in \ref cus_camsensor_init_handle
+    */
+    int (*pCus_sensor_release)(struct __ms_cus_sensor* handle);
+
+    /** @brief Enter sensor suspend mode
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark ISP call this function before enter power saving mode
+    */
+    int (*pCus_sensor_suspend)(struct __ms_cus_sensor* handle);
+
+    /** @brief Sensor wakeup
+    @param[in] handle Handle to sensor driver.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark ISP call this function after exit power saving mode
+    */
+    int (*pCus_sensor_resume)(struct __ms_cus_sensor* handle);
+
+    /** @brief Enable sensor pattern mode if sensor hardward supported
+    @param[in] handle Handle to sensor driver.
+    @param[in] mode Pattern select, if 0 disable pattern mode.
+    @retval SUCCESS or FAIL if error occurs.
+    @remark This function is optional
+    */
+    int (*pCus_sensor_SetPatternMode)(struct __ms_cus_sensor* handle,u32 mode);
+
+    // Normal
+
+    /** @brief Check sensor ID and report to ISP sensor match or not
+    @param[in] handle Handle to sensor driver.
+    @param[out] id Receive 4 bytes customer defined sensor ID.
+    @retval Return SUCCESS if sensor matched or Retuen FAIL if sensor mismatch.
+    @remark Read sensor ID through I2C
+    */
+    int (*pCus_sensor_GetSensorID)(struct __ms_cus_sensor* handle, u32 *id);
+
+     /** @brief Get resolution list
+    @param[in] handle Handle to sensor driver.
+    @param[out] id Receive supported resolution list
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetVideoRes)(struct __ms_cus_sensor* handle, u32 res_idx, cus_camsensor_res **res);
+
+     /** @brief Get resolution list
+    @param[in] handle Handle to sensor driver.
+    @param[out] id Receive supported resolution list
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetCurVideoRes)(struct __ms_cus_sensor* handle, u32 *cur_idx, cus_camsensor_res **res);
+
+     /** @brief Select a sensor output resolution sensor list
+    @param[in] handle Handle to sensor driver.
+    @param[in] res_id Resolution id
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_SetVideoRes)(struct __ms_cus_sensor* handle, u32 res_id);
+
+     /** @brief Get sensor current mirror flip setting
+    @param[in] handle Handle to sensor driver.
+    @param[out] ori Receive Mirror/Flip setting.
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetOrien)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_ORIT *ori);
+
+     /** @brief Select a sensor mirror flip
+    @param[in] handle Handle to sensor driver.
+    @param[in] ori Mirror/Flip configuration.
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_SetOrien)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_ORIT ori);
+
+     /** @brief Get sensor capability
+    @param[in] handle Handle to sensor driver.
+    @param[out] cap Receive sensor capability
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetSensorCap)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_CAP *cap);
+
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+
+     /** @brief AE/Frame status change notification
+    @param[in] handle Handle to sensor driver.
+    @param[in] status Current status
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_AEStatusNotify)(struct __ms_cus_sensor* handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+
+     /** @brief Get sensor shutter setting in us
+    @param[in] handle Handle to sensor driver.
+    @param[out] us Receive current shutter setting
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_GetAEUSecs)(struct __ms_cus_sensor* handle, u32 *us);
+
+     /** @brief Set sensor shutter in us
+    @param[in] handle Handle to sensor driver.
+    @param[in] us Shutter setting in us
+    @retval Return SUCCESS or FAIL if error occurs.
+    */
+    int (*pCus_sensor_SetAEUSecs)(struct __ms_cus_sensor* handle, u32 us);
+
+    // Gain: 1x = 1024
+    /** @brief Get sensor current AE gain
+    @param[in] handle Handle to sensor driver.
+    @param[out] gain Receive current AE gain
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_GetAEGain)(struct __ms_cus_sensor* handle, u32* gain);
+
+    /** @brief Set sensor AE gain
+    @param[in] handle Handle to sensor driver.
+    @param[in] gain AE gain
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_SetAEGain)(struct __ms_cus_sensor* handle, u32 gain);
+
+    /** @brief Get supported shutter range
+    @param[in] handle Handle to sensor driver.
+    @param[out] min Receive minimum shutter which sensor can supported
+    @param[out] min Receive maxiimum shutter which sensor can supported
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_GetAEMinMaxUSecs)(struct __ms_cus_sensor* handle, u32 *min, u32 *max);
+
+    /** @brief Get supported AE gain range
+    @param[in] handle Handle to sensor driver.
+    @param[out] min Receive minimum gain which sensor can supported
+    @param[out] min Receive maxiimum gain which sensor can supported
+    @retval Return SUCCESS or FAIL if error occurs.
+    @remark gain: 1x = 1024
+    */
+    int (*pCus_sensor_GetAEMinMaxGain)(struct __ms_cus_sensor* handle, u32 *min, u32 *max);
+
+    // frame rate control
+    /** @brief Get current fps
+    @param[in] handle Handle to sensor driver.
+    @retval Return current frame rate per second
+    */
+    int (*pCus_sensor_GetFPS)(struct __ms_cus_sensor* handle);
+
+    /** @brief Set sensor output fps
+    @param[in] handle Handle to sensor driver.
+    @param[in] fps
+    @retval Return SUCCESS or FAIL if fps is out of range.
+    */
+    int (*pCus_sensor_SetFPS)(struct __ms_cus_sensor* handle, u32 fps);
+
+    //[OPTIONAL] sensor calibration
+    /** @brief Optional function */
+    int (*pCus_sensor_SetAEGain_cal)(struct __ms_cus_sensor* handle, u32);
+
+    /** @brief Optional function */
+    int (*pCus_sensor_setCaliData_gain_linearity)(struct __ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray ,u32 num);
+
+    //Get shutter information
+    /** @brief Get shutter information
+    @param[in] handle Handle to sensor driver.
+    @param[out] info return shutter information.
+    @retval Return current frame rate per second
+    */
+    int (*pCus_sensor_GetShutterInfo)(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info);
+
+    /** @brief Get resolution list number
+   @param[in] handle Handle to sensor driver.
+   @param[out] ulres_num resolution list number
+   @retval Return SUCCESS or FAIL if error occurs.
+   */
+   int (*pCus_sensor_GetVideoResNum)(struct __ms_cus_sensor* handle, u32 *ulres_num);
+
+   //Get shutter information
+   /** @brief Sensor vendor command
+   @param[in] handle Handle to sensor driver.
+   @param[in] reserved
+   @param[in] param Command input
+   @param[out] out Command output
+   @retval Return SUCCESS or FAIL if error occurs.
+   */
+   int (*pCus_sensor_CustDefineFunction)(struct __ms_cus_sensor* handle,u32 cmd_id, void *param);
+
+   //Get Source Type
+   /** @brief Get Source Type
+   @param[in] handle Handle to sensor driver.
+   @param[in] plane id.
+   @param[out] psrc_type info
+   @retval Return SUCCESS or FAIL if error occurs.
+   */
+   int (*pCus_sensor_GetSrcType)(struct __ms_cus_sensor* handle, u32 plane_id, CUS_SNR_ANADEC_SRC_TYPE *psrc_type);
+
+   // Gain: 1x = 1024
+   /** @brief Try AE gain value
+   @param[in] handle Handle to sensor driver.
+   @param[in] Target AE gain value to try
+   @retval Return actual sensor gain will apply on the HW.
+   @remark gain: 1x = 1024
+   */
+   u32 (*pCus_sensor_TryAEGain)(struct __ms_cus_sensor* handle, u32 gain);
+
+   // Return actual shutter
+   /** @brief Try AE shutter value
+   @param[in] handle Handle to sensor driver.
+   @param[in] Target AE shutter value to try , in us
+   @retval Return actual sensor gain will apply on the HW.
+   @remark gain: 1x = 1024
+   */
+   u32 (*pCus_sensor_TryAEShutter)(struct __ms_cus_sensor* handle, u32 us);
+
+   int (*pCus_sensor_SwitchgSensorId)(struct __ms_cus_sensor* handle,u32 sensorId);
+ 
+   int (*pCus_sensor_GetCurSwtichSensorId)(struct __ms_cus_sensor* handle,u32 *pu32sensorId);
+} ms_cus_sensor;
+
+/** @brief Sensor driver entry. ISP call this function before start using sensor driver. \n
+ISP pass \ref ms_cus_sensor struct to obtain the driver information and function entries. \n
+And all allocated resources here should be released at \ref __ms_cus_sensor::pCus_sensor_release.
+Every sensor driver must implement this api.
+@param[in] drv_handle A uninitialized \ref ms_cus_sensor struct from ISP, Sensor driver fill the driver information and function entries to drv_handle.
+@retval SUCCESS or FAIL if error occurs.
+*/
+
+typedef int (*SensorInitHandle)(ms_cus_sensor* handle);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* DRV_MS_CUS_SENSOR_H_ */
+/** @} */ // end of ISP Sensor Driver Interface
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor.h b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor.h
new file mode 100644
index 00000000..36452880
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor.h
@@ -0,0 +1,53 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifndef DRV_SENSOR_H
+#define DRV_SENSOR_H
+
+#include <cam_os_wrapper.h>
+
+#define SENSOR_DMSG(args...) do{}while(0)
+#define SENSOR_EMSG(args...) CamOsPrintf(args)
+#define SENSOR_IMSG(args...) CamOsPrintf(args)
+#if 0
+typedef enum {
+    I2C_FMT_A8D8, /**< 8 bits Address, 8 bits Data */
+    I2C_FMT_A16D8,/**< 16 bits Address 8 bits Data */
+    I2C_FMT_A8D16,/**< 8 bits Address 16 bits Data */
+    I2C_FMT_A16D16,/**< 16 bits Address 16 bits Data */
+    I2C_FMT_END/**< Reserved */
+} ISP_I2C_FMT;
+#endif
+
+extern s32 WriteRegisterPair(int slaveAddr, short reg, unsigned short value, ISP_I2C_FMT fmt);
+extern u64 intlog10(u32 value);
+extern u64 intlog2(u32 value);
+extern s32 DrvRegisterSensorDriver(u32 nCamID, SensorInitHandle pfnSensorInitHandle);
+extern s32 DrvRegisterPlaneDriver(u32 nCamID, u32 nPlaneID, SensorInitHandle pfnSensorInitHandle);
+extern s32 DrvRegisterSensorDriverEx(u32 nSNRPadID, SensorInitHandle pfnSensorInitHandle, void *pPrivateData);
+extern s32 DrvRegisterPlaneDriverEx(u32 nSNRPadID, u32 nPlaneID, SensorInitHandle pfnSensorInitHandle, void *pPrivateData);
+extern s32 DrvSensorRelease(u32 nSNRPadID);
+extern s32 DrvSensorEarlyInitSync(u32 nSNRPadID);
+extern s32 DrvRegisterSensorI2CSlaveID(u32 nCamID, u32 Slaveid);
+extern s32 DrvRegisterPlaneI2CSlaveID(u32 nCamID, u32 nPlaneID, u32 Slaveid);
+extern s32 DrvSensorHandleVer(u32 version_major, u32 version_minor);
+extern s32 DrvSensorIFVer(u32 version_major, u32 version_minor);
+extern s32 DrvSensorI2CVer(u32 version_major, u32 version_minor);
+#define DrvUnregisterSensorDriverEx(nSNRPadID) DrvSensorRelease((nSNRPadID))
+
+#define SENSOR_USLEEP(us) CamOsUsSleep(us)
+#define SENSOR_MSLEEP(ms) CamOsMsSleep(ms)
+#define SENSOR_UDELAY(us) CamOsUsDelay(us)
+#define SENSOR_MDELAY(ms) CamOsMsDelay(ms)
+#endif
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor_common.h b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor_common.h
new file mode 100644
index 00000000..88b2b38c
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor_common.h
@@ -0,0 +1,379 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifndef _SENSOR_OS_WRAPPER_H_
+#define _SENSOR_OS_WRAPPER_H_
+
+#if defined(__KERNEL__)
+#define CAM_OS_LINUX_KERNEL
+#endif
+
+#include <cam_os_wrapper.h>
+#include <drv_ms_cus_sensor.h>
+#include <drv_sensor.h>
+
+/******************************************************** RTK ***********************************************************/
+#if defined(CAM_OS_RTK)
+typedef unsigned char bool;
+#ifndef true
+#define true                        1
+#define false                       0
+#endif
+
+#ifndef _SENSOR_SLAVE_ID_
+#define _SENSOR_SLAVE_ID_ 0
+#endif
+
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN(NAME)
+
+#define SENSOR_DRV_ENTRY_IMPL_END(Name,LinearEntry,HdrSefEntry,HdrLefEntry)\
+int Name##_init_driver(unsigned char chmap)\
+{\
+    int nCamID=0;\
+    /*To avoid compile warning*/\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    for(nCamID=0;nCamID<4;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){ DrvRegisterSensorDriver(nCamID, LinearEntry);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p1){ DrvRegisterPlaneDriver(nCamID, 1, HdrSefEntry);\
+                DrvRegisterPlaneI2CSlaveID(nCamID, 1, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p2){ DrvRegisterPlaneDriver(nCamID, 0, HdrLefEntry);\
+                DrvRegisterPlaneI2CSlaveID(nCamID, 0, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+        }\
+    }\
+    return 0;\
+}
+
+static volatile int lane_num = 2;
+static volatile int hdr_lane_num=2;
+
+#define SENSOR_DRV_PARAM_MCLK() "NONE"
+#define SENSOR_USLEEP_(us) {CamOsUsDelay(us);}
+#define SENSOR_MSLEEP_(ms) {CamOsMsDelay(ms);}
+
+/*Extension version*/
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(NAME) SENSOR_DRV_ENTRY_IMPL_BEGIN(NAME)
+
+#define MAX_CAMID_LEN 4
+#define SENSOR_DRV_ENTRY_IMPL_END_EX(Name,LinearEntry,HdrSefEntry,HdrLefEntry,PrivateDataType)\
+static PrivateDataType* g_pData[2][MAX_CAMID_LEN] = {{0,0,0,0}, {0,0,0,0}};\
+static PrivateDataType g_PrivData[2][MAX_CAMID_LEN];\
+int Name##_init_driver(unsigned char chmap)\
+{\
+    int nCamID=0;\
+    /*To avoid compile warning*/\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){\
+                /*void* pData = CamOsMemAlloc(sizeof(PrivateDataType));*/\
+                void* pData = &g_PrivData[0][nCamID];/*Change private data to static var*/\
+                memset(pData,0,sizeof(PrivateDataType));\
+                DrvRegisterSensorDriverEx(nCamID, LinearEntry,pData);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                SENSOR_DMSG("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+                g_pData[0][nCamID] = pData;\
+            }\
+            if(p1||p2){\
+                /*void* pData = CamOsMemAlloc(sizeof(PrivateDataType));*/\
+                void* pData = &g_PrivData[1][nCamID];/*Change private data to static var*/\
+                memset(pData,0,sizeof(PrivateDataType));\
+                if(p1){\
+                    DrvRegisterPlaneDriverEx(nCamID, 1, HdrSefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 1, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                    SENSOR_DMSG("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p2){\
+                    DrvRegisterPlaneDriverEx(nCamID, 0, HdrLefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 0, (_SENSOR_SLAVE_ID_>>(nCamID*8))&0xFF);\
+                    SENSOR_DMSG("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                g_pData[1][nCamID] = pData;\
+            }\
+            DrvSensorEarlyInitSync(nCamID);\
+        }\
+    }\
+    return 0;\
+}\
+\
+int Name##_deinit_driver(unsigned char chmap)\
+{\
+    int nCamID=0;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(g_pData[0][nCamID] || g_pData[1][nCamID])\
+            {\
+                DrvUnregisterSensorDriverEx(nCamID);\
+                if(g_pData[0][nCamID]){\
+                    /*CamOsMemRelease((void*)g_pData[0][nCamID]);*/\
+                    g_pData[0][nCamID] = 0;\
+                }\
+                if(g_pData[1][nCamID]){\
+                    /*CamOsMemRelease((void*)g_pData[1][nCamID]);*/\
+                    g_pData[1][nCamID] = 0;\
+                }\
+            }\
+        }\
+    }\
+    return 0;\
+}
+/******************************************************** LINUX ***********************************************************/
+#elif defined(CAM_OS_LINUX_KERNEL)
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/string.h>
+#include <linux/delay.h>
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN(Name) \
+int chmap = 0;\
+module_param(chmap, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(chmap, "VIF channel mapping");\
+char *mclk = "use default parameter";\
+module_param(mclk, charp, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(mclk, "Assign MCLK");
+int lane_num = 2;\
+module_param(lane_num, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(lane_num, "sensor output lane number");
+int hdr_lane_num = 4;\
+module_param(hdr_lane_num, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(hdr_lane_num, "sensor output lane number");
+int i2c_slave_id = 0;\
+module_param(i2c_slave_id, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP);\
+MODULE_PARM_DESC(i2c_slave_id, "sensor i2c slave id");
+
+#define SENSOR_DRV_ENTRY_IMPL_END(Name,LinearEntry,HdrSefEntry,HdrLefEntry) \
+static int __init Name##_init_driver(void)\
+{\
+    int nCamID=0;\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    if(DrvSensorHandleVer(CUS_CAMSENSOR_HANDLE_MAJ_VER, CUS_CAMSENSOR_HANDLE_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorIFVer(CUS_CAMSENSORIF_MAJ_VER, CUS_CAMSENSORIF_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorI2CVer(CUS_CAMSENSOR_I2C_MAJ_VER, CUS_CAMSENSOR_I2C_MIN_VER)==FAIL)\
+    return FAIL;\
+    for(nCamID=0;nCamID<4;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){ DrvRegisterSensorDriver(nCamID, LinearEntry);\
+            DrvRegisterSensorI2CSlaveID(nCamID, (i2c_slave_id>>(nCamID*8))&0xFF);\
+            pr_info("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p1){ DrvRegisterPlaneDriver(nCamID, 1, HdrSefEntry);\
+            DrvRegisterPlaneI2CSlaveID(nCamID, 1, (i2c_slave_id>>(nCamID*8))&0xFF);\
+            pr_info("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+            if(p2){ DrvRegisterPlaneDriver(nCamID, 0, HdrLefEntry);\
+            DrvRegisterPlaneI2CSlaveID(nCamID, 0, (i2c_slave_id>>(nCamID*8))&0xFF);\
+            pr_info("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+            }\
+        }\
+    }\
+    return 0;\
+}\
+static void __exit Name##_exit_driver(void)\
+{\
+    pr_info("sensordrv exit");\
+}\
+subsys_initcall(Name##_init_driver);\
+module_exit(Name##_exit_driver);\
+MODULE_DESCRIPTION("Sensor_"#Name);\
+MODULE_AUTHOR("SigmaStar");\
+MODULE_LICENSE("Proprietary");
+
+#define SENSOR_DRV_PARAM_MCLK() (mclk)
+#define SENSOR_USLEEP_(us) CamOsUsSleep(us)
+#define SENSOR_MSLEEP_(ms) CamOsMsSleep(ms)
+
+/*Extension version*/
+#define SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(Name) SENSOR_DRV_ENTRY_IMPL_BEGIN(Name)
+
+#define MAX_CAMID_LEN 4
+#define SENSOR_DRV_ENTRY_IMPL_END_EX(Name,LinearEntry,HdrSefEntry,HdrLefEntry,PrivateDataType) \
+static PrivateDataType* g_pData[2][MAX_CAMID_LEN] = {{0,0,0,0}, {0,0,0,0}};\
+static int __init Name##_init_driver(void)\
+{\
+    int nCamID=0;\
+    void* p0 = LinearEntry;\
+    void* p1 = HdrSefEntry;\
+    void* p2 = HdrLefEntry;\
+    if(DrvSensorHandleVer(CUS_CAMSENSOR_HANDLE_MAJ_VER, CUS_CAMSENSOR_HANDLE_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorIFVer(CUS_CAMSENSORIF_MAJ_VER, CUS_CAMSENSORIF_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorI2CVer(CUS_CAMSENSOR_I2C_MAJ_VER, CUS_CAMSENSOR_I2C_MIN_VER)==FAIL)\
+    return FAIL;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                DrvRegisterSensorDriverEx(nCamID, LinearEntry,pData);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                pr_info("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+                g_pData[0][nCamID] = pData;\
+            }\
+            if(p1||p2){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                if(p1){\
+                    DrvRegisterPlaneDriverEx(nCamID, 1, HdrSefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 1, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s SEF to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p2){\
+                    DrvRegisterPlaneDriverEx(nCamID, 0, HdrLefEntry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 0, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s LEF to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                g_pData[1][nCamID] = pData;\
+            }\
+        }\
+    }\
+    return 0;\
+}\
+static void __exit Name##_exit_driver(void)\
+{\
+    int nCamID=0;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(g_pData[0][nCamID] || g_pData[1][nCamID])\
+            {\
+                DrvUnregisterSensorDriverEx(nCamID);\
+                if(g_pData[0][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[0][nCamID]);\
+                    g_pData[0][nCamID] = 0;\
+                }\
+                if(g_pData[1][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[1][nCamID]);\
+                    g_pData[1][nCamID] = 0;\
+                }\
+            }\
+        }\
+    }\
+}\
+subsys_initcall(Name##_init_driver);\
+module_exit(Name##_exit_driver);\
+MODULE_DESCRIPTION("Sensor_"#Name);\
+MODULE_AUTHOR("SigmaStar");\
+MODULE_LICENSE("Proprietary");
+                
+//define 3 ch AHD application impl
+#define SENSOR_DRV_ENTRY_3CHAHD_IMPL_END_EX(Name,LinearEntry,AhdCh0Entry,AhdCh1Entry, AhdCh2Entry,PrivateDataType)\
+static PrivateDataType* g_pData[2][MAX_CAMID_LEN] = {{0,0,0,0}, {0,0,0,0}};\
+static int __init Name##_init_driver(void)\
+{\
+    int nCamID=0;\
+    void* p0 = LinearEntry;\
+    void* p1 = AhdCh0Entry;\
+    void* p2 = AhdCh1Entry;\
+    void* p3 = AhdCh2Entry;\
+    if(DrvSensorHandleVer(CUS_CAMSENSOR_HANDLE_MAJ_VER, CUS_CAMSENSOR_HANDLE_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorIFVer(CUS_CAMSENSORIF_MAJ_VER, CUS_CAMSENSORIF_MIN_VER)==FAIL)\
+    return FAIL;\
+    if(DrvSensorI2CVer(CUS_CAMSENSOR_I2C_MAJ_VER, CUS_CAMSENSOR_I2C_MIN_VER)==FAIL)\
+    return FAIL;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(p0){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                DrvRegisterSensorDriverEx(nCamID, LinearEntry,pData);\
+                DrvRegisterSensorI2CSlaveID(nCamID, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                pr_info("Connect %s linear to sensor pad %d\n",__FUNCTION__, nCamID);\
+                g_pData[0][nCamID] = pData;\
+            }\
+            if(p1||p2||p3){\
+                void* pData = CamOsMemAlloc(sizeof(PrivateDataType));\
+                memset(pData,0,sizeof(PrivateDataType));\
+                if(p1){\
+                    DrvRegisterPlaneDriverEx(nCamID, 0, AhdCh0Entry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 0, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s AHD0 to vif sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p2){\
+                    DrvRegisterPlaneDriverEx(nCamID, 1, AhdCh1Entry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 1, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s AHD1 to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                if(p3){\
+                    DrvRegisterPlaneDriverEx(nCamID, 2, AhdCh2Entry,pData);\
+                    DrvRegisterPlaneI2CSlaveID(nCamID, 2, (i2c_slave_id>>(nCamID*8))&0xFF);\
+                    pr_info("Connect %s AHD2 to sensor pad %d\n",__FUNCTION__, nCamID);\
+                }\
+                g_pData[1][nCamID] = pData;\
+            }\
+        }\
+    }\
+    return 0;\
+}\
+static void __exit Name##_exit_driver(void)\
+{\
+    int nCamID=0;\
+    for(nCamID=0;nCamID<MAX_CAMID_LEN;++nCamID)\
+    {\
+        if((chmap>>nCamID)&0x1)\
+        {\
+            if(g_pData[0][nCamID] || g_pData[1][nCamID])\
+            {\
+                DrvUnregisterSensorDriverEx(nCamID);\
+                if(g_pData[0][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[0][nCamID]);\
+                    g_pData[0][nCamID] = 0;\
+                }\
+                if(g_pData[1][nCamID]){\
+                    CamOsMemRelease((void*)g_pData[1][nCamID]);\
+                    g_pData[1][nCamID] = 0;\
+                }\
+            }\
+        }\
+    }\
+}\
+subsys_initcall(Name##_init_driver);\
+module_exit(Name##_exit_driver);\
+MODULE_DESCRIPTION("Sensor_"#Name);\
+MODULE_AUTHOR("SigmaStar");\
+MODULE_LICENSE("Proprietary");
+
+#endif //end of CAM_OS_LINUX_KERNEL
+
+
+#endif //endif _SENSOR_OS_WRAPPER_H_
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor_init_table.h b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor_init_table.h
new file mode 100644
index 00000000..10368d9e
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/drv_sensor_init_table.h
@@ -0,0 +1,114 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifndef _DRV_SENSOR_INIT_H_
+#define _DRV_SENSOR_INIT_H_
+
+//#define SENSOR_INIT_CMDQ_MODE
+#define SENSOR_INIT_DRV_MODE
+
+/* for sensor driver */
+#define I2C_1A1B_W(reg,val) {(reg),(val)}
+#define CMDQ_DELAY_MS(ms) {(0xFFFF),(ms)}
+
+#define I2CM_1A1D_W(slave_addr,reg,val) \
+        {(reg),(val)}
+
+#define I2CM_1A1D_W_BURST2(slave_addr,reg,d0,d1) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)}
+
+#define I2CM_1A1D_W_BURST3(slave_addr,reg,d0,d1,d2) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)}
+
+#define I2CM_1A1D_W_BURST4(slave_addr,reg,d0,d1,d2,d3) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)}
+
+#define I2CM_1A1D_W_BURST5(slave_addr,reg,d0,d1,d2,d3,d4) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)}
+
+#define I2CM_1A1D_W_BURST6(slave_addr,reg,d0,d1,d2,d3,d4,d5) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)},\
+        {(reg)+5,(d5)}
+
+#define I2CM_1A1D_W_BURST7(slave_addr,reg,d0,d1,d2,d3,d4,d5,d6) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)},\
+        {(reg)+5,(d5)},\
+        {(reg)+6,(d6)}
+
+#define I2CM_2A1D_W(slave_addr,reg,val) \
+        {(reg),(val)}
+
+#define I2CM_2A1D_W_BURST2(slave_addr,reg,d0,d1) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)}
+
+#define I2CM_2A1D_W_BURST3(slave_addr,reg,d0,d1,d2) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)}
+
+#define I2CM_2A1D_W_BURST4(slave_addr,reg,d0,d1,d2,d3) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)}
+
+#define I2CM_2A1D_W_BURST5(slave_addr,reg,d0,d1,d2,d3,d4) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)}
+
+#define I2CM_2A1D_W_BURST6(slave_addr,reg,d0,d1,d2,d3,d4,d5) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)},\
+        {(reg)+3,(d3)},\
+        {(reg)+4,(d4)},\
+        {(reg)+5,(d5)}
+
+#define I2CM_2A2D_W(slave_addr,reg,val) \
+        {(reg),(val)}
+
+#define I2CM_2A2D_W_BURST2(slave_addr,reg,d0,d1) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)}
+
+#define I2CM_2A2D_W_BURST3(slave_addr,reg,d0,d1,d2) \
+        {(reg),(d0)},\
+        {(reg)+1,(d1)},\
+        {(reg)+2,(d2)}
+
+#define SENSOR_INIT_TABLE I2C_ARRAY
+
+#endif
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/sensor_i2c_api.h b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/sensor_i2c_api.h
new file mode 100644
index 00000000..4de7027c
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/include/sensor_i2c_api.h
@@ -0,0 +1,168 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+/*! @file isp_i2c_api.h
+      @brief This file contains Infinity ISP I2C basic API.
+*/
+
+/** @defgroup group1 ISP I2C API
+* @{
+*/
+#ifndef ISP_I2C_API_H
+#define ISP_I2C_API_H
+
+#define SENSOR_I2C_SUCCESS (0)
+#define SENSOR_I2C_FAIL (-1)
+#define SENSOR_I2C_NOT_SUPPORT (-2)
+
+/**@brief handle version info */
+typedef struct _version_info{
+    u16          major;
+    u16          minor;
+}__attribute__((packed, aligned(1))) version_info;
+
+/*! @brief I2C API handle.*/
+struct __i2c_handle_t;
+
+/*! @brief I2C batch read/write data.*/
+typedef struct _I2C_ARRAY{
+    u16 reg; /**< Register address.*/
+    u16 data; /**< Data.*/
+} I2C_ARRAY;
+
+/*! @brief I2C burst read/write data.*/
+typedef struct _I2C_ARRAY_BURST{
+    u16 reg; /**< Register address.*/
+    u16 *data; /**< Data.*/
+} I2C_ARRAY_BURST;
+
+/*! @brief I2C data direction*/
+typedef enum {
+    I2C_RW_R, /**< Data direction read.*/
+    I2C_RW_W,/**< Data direction write.*/
+} I2C_RW;
+
+/*! @brief Use for i2c_array_rw only */
+typedef struct _I2C_CPX_ARRAY{
+    I2C_RW  rw; /**< Data direction */
+    u16 reg; /**< Device register address */
+    u16 data; /**< Data write to device or read from device*/
+}__attribute__((packed, aligned(1))) I2C_CPX_ARRAY;
+
+/*! @brief Internal use for I2C API*/
+typedef enum {
+    I2C_FMT_A8D8, /**< 8 bits Address, 8 bits Data */
+    I2C_FMT_A16D8,/**< 16 bits Address 8 bits Data */
+    I2C_FMT_A8D16,/**< 8 bits Address 16 bits Data */
+    I2C_FMT_A16D16,/**< 16 bits Address 16 bits Data */
+    I2C_FMT_END/**< Reserved */
+} ISP_I2C_FMT;
+
+/*! @brief ISP_I2C_MODE Internal use for I2C API*/
+typedef enum {
+    I2C_LEGACY_MODE,    /**< Do not use */
+    I2C_NORMAL_MODE     /**< Sensor driver can only use I2C_NORMAL_MODE */
+} ISP_I2C_MODE;
+
+
+/*! @brief app_i2c_cfg I2C setting for sensor and bus.*/
+typedef struct _app_i2c_cfg{
+    ISP_I2C_MODE        mode;   //!< I2C_NORMAL_MODE only
+    ISP_I2C_FMT         fmt;        //!< I2C data format
+    u32                 speed;          //!< I2C clock in Hz
+    u16                 address;       //!< Sensor slave address , bit[7~1] are available, bit[0] user don't care
+    u16  reserved;
+}__attribute__((packed, aligned(1))) app_i2c_cfg;
+
+/*! @brief The interface of I2C APIs export to user*/
+typedef struct _i2c_handle_t {
+    //int version;
+    version_info version;
+    void *pdata; //i2c_private_data
+
+    u32 nSensorID;
+    /** @brief Open isp i2c port. This function must be called before using isp I2C  APIs.
+    Call i2c_close to close isp i2c port and allocated resource.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C initial configuration.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_open)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg);
+
+    /** @brief Close isp I2C port. Call this functon to release resource which allocated form i2c_open.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C configuration mode and spped are necessary in this stage.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_close)(struct _i2c_handle_t* handle );
+
+    /** @brief Write single data to device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] reg Device register address address width depend on cfg->fmt.
+    @param[in] data Data to write, data width depend on cfg->fmt.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_tx)(struct _i2c_handle_t* handle , app_i2c_cfg *cfg, u16 reg, u16 data);
+
+    /** @brief Read single data from device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] reg Device register address address width depend on cfg->fmt.
+    @param[out] data Data buffer for read, data width depend on cfg->fmt.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_rx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, u16 reg, volatile u16 *data);
+
+    /** @brief Batch write to device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] pdata Data array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_array_tx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY *pdata, u32 len);
+
+    /** @brief Burst write to device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in] pdata Data array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_burst_tx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY_BURST *pdata, u32 len);
+
+    int (*i2c_burst_rx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY_BURST *pdata, u32 len);
+    /** @brief Batch read from device.
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[out] pdata Data array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_array_rx)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_ARRAY *pdata, u32 len);
+
+    /** @brief Composite batch read/write
+    @param[in] handle Handle to isp i2c api.
+    @param[in] cfg I2C config, fmd and address are necessary in this stage.
+    @param[in][out] pdata Data description array.
+    @param[in] len Array size.
+    @retval SENSOR_I2C_SUCCESS or SENSOR_I2C_FAIL if error occurs.
+    */
+    int (*i2c_array_rw)(struct _i2c_handle_t* handle, app_i2c_cfg *cfg, I2C_CPX_ARRAY *pdata, u32 len);
+} i2c_handle_t;
+
+/** @} */ // end of ISP I2C API
+
+#endif
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx274_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx274_mipi.c
new file mode 100644
index 00000000..ae86d60a
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx274_mipi.c
@@ -0,0 +1,4112 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(IMX274_HDR);
+
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE_LINEAR CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (4)
+//#define SENSOR_MIPI_HDR_MODE (1) //0: Non-HDR mode. 1:Sony DOL mode
+//MIPI config end.
+//============================================
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+//#undef SENSOR_DBG
+//#define SENSOR_DBG 0
+
+///////////////////////////////////////////////////////////////
+//          @@@                                                                                       //
+//       @   @@      ==  S t a r t * H e r e ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                           //
+//         @@@@                                                                                  //
+//                                                                                                     //
+//      Start Step 1 --  show preview on LCM                                         //
+//                                                                                                    �@//
+//  Fill these #define value and table with correct settings                        //
+//      camera can work and show preview on LCM                                 //
+//                                                                                                       //
+///////////////////////////////////////////////////////////////
+
+
+#define SENSOR_ISP_TYPE     ISP_EXT                   //ISP_EXT, ISP_SOC
+#define F_number  22                                  // CFG, demo module
+//#define SENSOR_DATAFMT      CUS_DATAFMT_BAYER        //CUS_DATAFMT_YUV, CUS_DATAFMT_BAYER
+#define SENSOR_IFBUS_TYPE   CUS_SENIF_BUS_MIPI      //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE PACKET_HEADER_EDGE1
+#define SENSOR_MIPI_HSYNC_MODE_HDR_DOL PACKET_FOOTER_EDGE
+#define SENSOR_DATAPREC     CUS_DATAPRECISION_12    //CFG //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#define SENSOR_DATAPREC_HDR_DOL     CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE     CUS_SEN_10TO12_9098     //CFG
+#define SENSOR_BAYERID      CUS_BAYER_RG            //CFG //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_BAYERID_HDR_DOL      CUS_BAYER_RG//CUS_BAYER_GR
+#define SENSOR_RGBIRID      CUS_RGBIR_NONE
+#define SENSOR_ORIT         CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+//#define SENSOR_MAX_GAIN     350                  // max sensor again, a-gain * conversion-gain*d-gain//51db
+//#define SENSOR_MAX_GAIN     22.5                 // max sensor again, a-gain * conversion-gain*d-gain*expand gain//63db
+#define SENSOR_MAX_GAIN     (1412 * 1024)
+#define SENSOR_MIN_GAIN      (1 * 1024)
+#define lane_number 4
+#define vc0_hs_mode 3   //0: packet header edge  1: line end edge 2: line start edge 3: packet footer edge
+#define long_packet_type_enable 0x00 //UD1~UD8 (user define)
+
+#define Preview_MCLK_SPEED  CUS_CMU_CLK_24MHZ        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+#define Preview_MCLK_SPEED_HDR_DOL  CUS_CMU_CLK_24MHZ
+
+u32 Preview_line_period;
+u32 vts_30fps;
+
+u32 Preview_line_period_HDR_DOL;
+u32 vts_30fps_HDR_DOL;
+
+#define Preview_WIDTH       3840                    //resolution Width when preview
+#define Preview_HEIGHT      2160                    //resolution Height when preview
+#define Preview_MAX_FPS     15                     //fastest preview FPS
+#define Preview_MIN_FPS     3                      //slowest preview FPS
+
+#define SENSOR_I2C_ADDR    0x34                   //I2C slave address
+#define SENSOR_I2C_SPEED   200000 //300000// 240000                  //I2C speed, 60000~320000
+
+#define SENSOR_I2C_LEGACY  I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT     I2C_FMT_A16D8        //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL     CUS_CLK_POL_NEG        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL      CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+
+#define SENSOR_VSYNC_POL    CUS_CLK_POL_NEG        // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL    CUS_CLK_POL_NEG        // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL     CUS_CLK_POL_NEG        // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+//static int  drv_Fnumber = 22;
+
+#define Preview_CROP_START_X    0                       //CROP_START_X
+#define Preview_CROP_START_Y    0                       //CROP_START_Y
+#define Preview_CROP_START_Y_DOL    8
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+static int pCus_SetAEUSecsHDR_DOL_SEF(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_SEF_Binning(ms_cus_sensor *handle, u32 us);
+
+CUS_CAMSENSOR_CAP sensor_cap = {
+    .length = sizeof(CUS_CAMSENSOR_CAP),
+    .version = 0x0001,
+};
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 expo_lef_us;
+        u32 expo_sef_us;
+    } expo;
+
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool dirty;
+    I2C_ARRAY vwinpos_nor[2];   //normal
+    I2C_ARRAY vwinpos_inv[2];   //inverted
+    I2C_ARRAY tVts_reg[3];
+    I2C_ARRAY tGain_reg[3];
+    I2C_ARRAY tExpo_reg[2];
+    I2C_ARRAY tExpo_shr_dol1_reg[2];
+    I2C_ARRAY tExpo_rhs1_reg[2];
+    I2C_ARRAY tExpo_shr_dol2_reg[2];
+    CUS_CAMSENSOR_ORIT cur_orien;
+    int vts_to_rhs1;
+} imx274_params;
+// set sensor ID address and data,
+
+const I2C_ARRAY Sensor_id_table[] =
+{
+    {0x3004, 0x03},      // {address of ID, ID },
+    {0x3005, 0x31},
+};
+
+const I2C_ARRAY Sensor_init_table_HDR_DOL_4lane_4k15fps[] =
+{
+#if 1 //DOL mode, MIPI clock 720M, VMAX 2310 @15fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xF0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x77},
+    {0x3135, 0x00},
+    {0x3136, 0x67},
+    {0x3137, 0x00},
+    {0x3138, 0x37},
+    {0x3139, 0x00},
+    {0x313a, 0x37},
+    {0x313b, 0x00},
+    {0x313c, 0x37},
+    {0x313d, 0x00},
+    {0x313e, 0xdf},
+    {0x313f, 0x00},
+    {0x3140, 0x37},
+    {0x3141, 0x00},
+    {0x3142, 0x2f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+//mode registers 15fps
+    {0x3004, 0x06},//shutter and gain
+    {0x3005, 0x01},
+    {0x3006, 0x00},
+    {0x3007, 0x02},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x31},
+    {0x301A, 0x00},
+    {0x3032, 0x40},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x00},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x31},
+    {0x3042, 0x08},
+    {0x3043, 0x02},
+
+    {0x306b, 0x05},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},
+    {0x30e1, 0x00},
+    {0x30e2, 0x01},
+    {0x30e9, 0x01},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x20},//HMAX
+    {0x30f7, 0x08},
+    {0x30f8, 0x06},//VMAX
+    {0x30f9, 0x09},
+    {0x30fa, 0x00},//
+    {0x3130, 0x86},
+    {0x3131, 0x08},
+    {0x3132, 0x00},
+    {0x3133, 0x00},
+
+    {0x3342, 0x0a},
+    {0x3343, 0x00},
+    {0x3344, 0x16},
+    {0x3345, 0x00},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0e},
+    {0x3554, 0x1f},
+    {0x3555, 0x01},
+    {0x3556, 0x01},
+    {0x3557, 0x01},
+    {0x3558, 0x01},
+    {0x3559, 0x00},
+    {0x355a, 0x00},
+    {0x35ba, 0x0e},
+    {0x366a, 0x1b},
+    {0x366b, 0x1a},
+    {0x366c, 0x19},
+    {0x366d, 0x17},
+    {0x3a41, 0x08},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+
+    //{0x300a, 0x80},//analog gain yc add
+   // {0x300b, 0x00},//yc add
+    //{0x3012, 0x05},//digital gain
+
+    //{0x300d, 0xff},//MSB
+    //{0x300c, 0x02},
+
+    {0x300c, 0x08},//yc add
+    {0x300d, 0x01},//yc add
+
+
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x02},//??
+    {0xffff, 0x07},//delay >=7ms
+
+   // {0x303c, 0x11},//test pattern
+   // {0x303d, 0x0a},
+
+    //setting3
+
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+    //{0x312e, 0x01},
+    //{0x3aa2, 0x01},
+
+   // {0x3001, 0x06}, // ?��?MIPI 2lane Mode Change
+#endif
+};
+
+const I2C_ARRAY Sensor_init_table_HDR_DOL_4lane_4k20fps[] =
+{
+#if 1 //DOL mode, MIPI clock 1152M, VMAX 2500 @20fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xC0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+
+    {0x3134, 0x8f},
+    {0x3135, 0x00},
+    {0x3136, 0x87},
+    {0x3137, 0x00},
+    {0x3138, 0x57},
+    {0x3139, 0x00},
+    {0x313a, 0x4f},
+    {0x313b, 0x00},
+    {0x313c, 0x4f},
+    {0x313d, 0x00},
+    {0x313e, 0x3f},
+    {0x313f, 0x01},
+    {0x3140, 0x57},
+    {0x3141, 0x00},
+    {0x3142, 0x47},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+
+    {0x3004, 0x06},//shutter and gain
+    {0x3005, 0x01},
+    {0x3006, 0x00},
+    {0x3007, 0x02},
+    
+    {0x300C, 0xE0},//yc add
+    {0x300D, 0x05},//yc add
+    
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x31},
+    {0x301A, 0x00},
+    {0x3032, 0x40},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x00},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x31},
+    {0x3042, 0x68},
+    {0x3043, 0x01},
+
+    {0x306b, 0x05},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},
+    {0x30e1, 0x00},
+    {0x30e2, 0x01},
+    {0x30e9, 0x01},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0xa0},//HMAX
+    {0x30f7, 0x05},
+    {0x30f8, 0xc4},//VMAX
+    {0x30f9, 0x09},
+    {0x30fa, 0x00},//
+    {0x3130, 0x86},
+    {0x3131, 0x08},
+    {0x3132, 0x00},
+    {0x3133, 0x00},
+
+    {0x3342, 0x0a},
+    {0x3343, 0x00},
+    {0x3344, 0x16},
+    {0x3345, 0x00},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0e},
+    {0x3554, 0x1f},
+    {0x3555, 0x01},
+    {0x3556, 0x01},
+    {0x3557, 0x01},
+    {0x3558, 0x01},
+    {0x3559, 0x00},
+    {0x355a, 0x00},
+    {0x35ba, 0x0e},
+    {0x366a, 0x1b},
+    {0x366b, 0x1a},
+    {0x366c, 0x19},
+    {0x366d, 0x17},
+    {0x3a41, 0x08},
+    {0xffff, 0x0a},//delay >=10ms
+
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x03},//??
+    {0xffff, 0x07},//delay >=7ms
+
+    //setting3
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+
+#endif
+};
+
+const I2C_ARRAY Sensor_init_table_HDR_DOL_4lane_4k30fps[] =
+{
+#if 1 //DOL mode, MIPI clock 1440M, VMAX 2275 @30fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xF0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+
+    {0x3134, 0xa7},
+    {0x3135, 0x00},
+    {0x3136, 0x9f},
+    {0x3137, 0x00},
+    {0x3138, 0x6f},
+    {0x3139, 0x00},
+    {0x313a, 0x5f},
+    {0x313b, 0x00},
+    {0x313c, 0x5f},
+    {0x313d, 0x00},
+    {0x313e, 0x7f},
+    {0x313f, 0x01},
+    {0x3140, 0x6f},
+    {0x3141, 0x00},
+    {0x3142, 0x4f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+
+    {0x3004, 0x05},//shutter and gain
+    {0x3005, 0x01},
+    {0x3006, 0x00},
+    {0x3007, 0x02},
+    
+    {0x300C, 0xFF},
+    {0x300D, 0x07},
+    
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x31},
+    {0x301A, 0x00},
+    {0x3032, 0x40},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x00},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x31},
+    {0x3042, 0x07},
+    {0x3043, 0x01},
+
+    {0x306b, 0x05},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},
+    {0x30e1, 0x00},
+    {0x30e2, 0x01},
+    {0x30e9, 0x01},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x20},//HMAX
+    {0x30f7, 0x04},
+    {0x30f8, 0xe3},//VMAX
+    {0x30f9, 0x08},
+    {0x30fa, 0x00},//
+    {0x3130, 0x86},
+    {0x3131, 0x08},
+    {0x3132, 0x7E},
+    {0x3133, 0x08},
+
+    {0x3342, 0x0a},
+    {0x3343, 0x00},
+    {0x3344, 0x16},
+    {0x3345, 0x00},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0e},
+    {0x3554, 0x1f},
+    {0x3555, 0x01},
+    {0x3556, 0x01},
+    {0x3557, 0x01},
+    {0x3558, 0x01},
+    {0x3559, 0x00},
+    {0x355a, 0x00},
+    {0x35ba, 0x0e},
+    {0x366a, 0x1b},
+    {0x366b, 0x1a},
+    {0x366c, 0x19},
+    {0x366d, 0x17},
+    {0x3a41, 0x08},
+    {0xffff, 0x0a},//delay >=10ms
+
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x02},//??
+    {0xffff, 0x07},//delay >=7ms
+
+    //setting3
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+
+#endif
+};
+
+
+
+const I2C_ARRAY Sensor_init_table_HDR_DOL_4lane_2M30fps[] =
+{
+#if 1 //H/V 2/2 line-binning DOL mode, MIPI clock 1152M, VMAX 2310 @30fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xC0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x8f},
+    {0x3135, 0x00},
+    {0x3136, 0x87},
+    {0x3137, 0x00},
+    {0x3138, 0x57},
+    {0x3139, 0x00},
+    {0x313a, 0x4f},
+    {0x313b, 0x00},
+    {0x313c, 0x4f},
+    {0x313d, 0x00},
+    {0x313e, 0x3f},
+    {0x313f, 0x00},
+    {0x3140, 0x57},
+    {0x3141, 0x00},
+    {0x3142, 0x47},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+
+//mode registers 30fps
+    {0x3004, 0x07},//shutter and gain
+    {0x3005, 0x21},
+    {0x3006, 0x00},
+    {0x3007, 0x11},
+    
+    {0x300C, 0x1F},
+    {0x300D, 0x08},
+    
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x31},
+    {0x301A, 0x00},
+    {0x3032, 0x40},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x00},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x31},
+    {0x3042, 0x04},
+    {0x3043, 0x01},
+
+    {0x306b, 0x05},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},
+    {0x30e1, 0x00},
+    {0x30e2, 0x02},
+    {0x30e9, 0x01},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x10},//HMAX[7:0]
+    {0x30f7, 0x04},//HMAX[15:8]
+    {0x30f8, 0x06},//VMAX[7:0]
+    {0x30f9, 0x09},//VMAX[15:8]
+    {0x30fa, 0x00},//VMAX[19:16]
+    {0x3130, 0x4e},
+    {0x3131, 0x04},
+    {0x3132, 0x00},
+    {0x3133, 0x00},
+
+    {0x3342, 0x0a},
+    {0x3343, 0x00},
+    {0x3344, 0x1a},
+    {0x3345, 0x00},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0e},
+    {0x3554, 0x00},
+    {0x3555, 0x01},
+    {0x3556, 0x01},
+    {0x3557, 0x01},
+    {0x3558, 0x01},
+    {0x3559, 0x00},
+    {0x355a, 0x00},
+    {0x35ba, 0x0e},
+    {0x366a, 0x1b},
+    {0x366b, 0x1a},
+    {0x366c, 0x19},
+    {0x366d, 0x17},
+    {0x3a41, 0x08},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+
+    //{0x300a, 0x80},//analog gain yc add
+   // {0x300b, 0x00},//yc add
+    //{0x3012, 0x05},//digital gain
+
+    //{0x300d, 0xff},//MSB
+    //{0x300c, 0x02},
+
+    //{0x300c, 0x08},//yc add
+    //{0x300d, 0x01},//yc add
+
+
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x03},//??
+    {0xffff, 0x07},//delay >=7ms
+
+   // {0x303c, 0x11},//test pattern
+   // {0x303d, 0x0a},
+
+    //setting3
+
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+    //{0x312e, 0x01},
+    //{0x3aa2, 0x01},
+
+    {0x3001, 0x10}, //terry
+#endif
+};
+
+
+const I2C_ARRAY Sensor_init_table_4lane_4K15fps[] =
+{
+//Linear mode, MIPI clock 720M, VMAX 8008 @15fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xF0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x77},
+    {0x3135, 0x00},
+    {0x3136, 0x67},
+    {0x3137, 0x00},
+    {0x3138, 0x37},
+    {0x3139, 0x00},
+    {0x313a, 0x37},
+    {0x313b, 0x00},
+    {0x313c, 0x37},
+    {0x313d, 0x00},
+    {0x313e, 0xdf},
+    {0x313f, 0x00},
+    {0x3140, 0x37},
+    {0x3141, 0x00},
+    {0x3142, 0x2f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+//mode registers 15fps
+    {0x3004, 0x00},//shutter and gain
+    {0x3005, 0x07},
+    {0x3006, 0x00},
+    {0x3007, 0x02},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x10},
+    {0x301A, 0x00},
+    {0x3032, 0x08},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x00},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x30},
+    {0x3042, 0x08},
+    {0x3043, 0x01},
+
+    {0x306b, 0x07},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},
+    {0x30e1, 0x00},
+    {0x30e2, 0x00},
+    {0x30e9, 0x00},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x2e},//HMAX
+    {0x30f7, 0x04},
+    {0x30f8, 0x86},//VMAX
+    {0x30f9, 0x11},
+    {0x30fa, 0x00},//
+    {0x3130, 0xaa},
+    {0x3131, 0x08},
+    {0x3132, 0x9a},
+    {0x3133, 0x08},
+
+    {0x3342, 0xff},
+    {0x3343, 0x01},
+    {0x3344, 0xff},
+    {0x3345, 0x01},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0f},
+    {0x3554, 0x00},
+    {0x3555, 0x00},
+    {0x3556, 0x00},
+    {0x3557, 0x00},
+    {0x3558, 0x00},
+    {0x3559, 0x1f},
+    {0x355a, 0x1f},
+    {0x35ba, 0x0f},
+    {0x366a, 0x00},
+    {0x366b, 0x00},
+    {0x366c, 0x00},
+    {0x366d, 0x00},
+    {0x3a41, 0x10},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+
+    //{0x300a, 0x80},//analog gain yc add
+   // {0x300b, 0x00},//yc add
+    //{0x3012, 0x05},//digital gain
+
+    //{0x300d, 0xff},//MSB
+    //{0x300c, 0x02},
+
+    {0x300c, 0x08},//yc add
+    {0x300d, 0x01},//yc add
+
+
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x02},//??
+    {0xffff, 0x07},//delay >=7ms
+
+   // {0x303c, 0x11},//test pattern
+   // {0x303d, 0x0a},
+
+    //setting3
+
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+    //{0x312e, 0x01},
+    //{0x3aa2, 0x01},
+
+   // {0x3001, 0x06}, // ?��?MIPI 2lane Mode Change
+};
+
+const I2C_ARRAY Sensor_init_table_4lane_4K20fps[] =
+{
+//Linear mode, MIPI clock 576Mbps, VMAX 4500 @20fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xC0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x5f},
+    {0x3135, 0x00},
+    {0x3136, 0x47},
+    {0x3137, 0x00},
+    {0x3138, 0x27},
+    {0x3139, 0x00},
+    {0x313a, 0x27},
+    {0x313b, 0x00},
+    {0x313c, 0x27},
+    {0x313d, 0x00},
+    {0x313e, 0x97},
+    {0x313f, 0x00},
+    {0x3140, 0x27},
+    {0x3141, 0x00},
+    {0x3142, 0x1f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+//mode registers 15fps
+    {0x3004, 0x00},//shutter and gain
+    {0x3005, 0x07},
+    {0x3006, 0x00},
+    {0x3007, 0x02},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x10},
+    {0x301A, 0x00},
+    {0x3032, 0x08},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x00},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x30},
+    {0x3042, 0x08},
+    {0x3043, 0x01},
+
+    {0x306b, 0x07},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},
+    {0x30e1, 0x00},
+    {0x30e2, 0x00},
+    {0x30e9, 0x00},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x20},//HMAX
+    {0x30f7, 0x03},
+    {0x30f8, 0x94},//VMAX
+    {0x30f9, 0x11},
+    {0x30fa, 0x00},//
+    {0x3130, 0xaa},
+    {0x3131, 0x08},
+    {0x3132, 0x9a},
+    {0x3133, 0x08},
+
+    {0x3342, 0xff},
+    {0x3343, 0x01},
+    {0x3344, 0xff},
+    {0x3345, 0x01},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0f},
+    {0x3554, 0x00},
+    {0x3555, 0x00},
+    {0x3556, 0x00},
+    {0x3557, 0x00},
+    {0x3558, 0x00},
+    {0x3559, 0x1f},
+    {0x355a, 0x1f},
+    {0x35ba, 0x0f},
+    {0x366a, 0x00},
+    {0x366b, 0x00},
+    {0x366c, 0x00},
+    {0x366d, 0x00},
+    {0x3a41, 0x10},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+
+    //{0x300a, 0x80},//analog gain yc add
+   // {0x300b, 0x00},//yc add
+    //{0x3012, 0x05},//digital gain
+
+    {0x300d, 0xff},//MSB
+    {0x300c, 0x02},
+
+    //{0x300c, 0x08},//yc add
+    //{0x300d, 0x01},//yc add
+
+
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x03},//??
+    {0xffff, 0x07},//delay >=7ms
+
+   // {0x303c, 0x11},//test pattern
+   // {0x303d, 0x0a},
+
+    //setting3
+
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+    //{0x312e, 0x01},
+    //{0x3aa2, 0x01},
+
+   // {0x3001, 0x06}, // ?��?MIPI 2lane Mode Change
+};
+
+const I2C_ARRAY Sensor_init_table_4lane_5M30fps[] =
+{
+//Linear mode, MIPI clock 576Mbps, VMAX 4620 @30fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xC0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x5f},
+    {0x3135, 0x00},
+    {0x3136, 0x47},
+    {0x3137, 0x00},
+    {0x3138, 0x27},
+    {0x3139, 0x00},
+    {0x313a, 0x27},
+    {0x313b, 0x00},
+    {0x313c, 0x27},
+    {0x313d, 0x00},
+    {0x313e, 0x97},
+    {0x313f, 0x00},
+    {0x3140, 0x27},
+    {0x3141, 0x00},
+    {0x3142, 0x1f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+//mode registers 5M@30fps
+    {0x3004, 0x00},//shutter and gain
+    {0x3005, 0x07},
+    {0x3006, 0x00},
+    {0x3007, 0xa2},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x10},
+    {0x301A, 0x00},
+    {0x3032, 0x08},
+    {0x3033, 0x00},
+
+    {0x3037, 0x01},
+    {0x3038, 0x70},
+    {0x3039, 0x02},//??
+    {0x303a, 0xa8},
+    {0x303b, 0x0c},
+
+    {0x3041, 0x30},
+    {0x3042, 0x08},
+    {0x3043, 0x01},
+
+    {0x306b, 0x07},
+    {0x30dd, 0x01},
+    {0x30de, 0x6c},
+    {0x30df, 0x00},
+    {0x30e0, 0x36},//inverted 0xca
+    {0x30e1, 0x00},//inverted 0x0f
+    {0x30e2, 0x00},
+    {0x30e9, 0x00},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x08},//HMAX
+    {0x30f7, 0x02},
+    {0x30f8, 0x0c},//VMAX
+    {0x30f9, 0x12},
+    {0x30fa, 0x00},//
+    {0x3130, 0xd2},
+    {0x3131, 0x07},
+    {0x3132, 0xc2},
+    {0x3133, 0x07},
+
+    {0x3342, 0xff},
+    {0x3343, 0x01},
+    {0x3344, 0xff},
+    {0x3345, 0x01},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0f},
+    {0x3554, 0x00},
+    {0x3555, 0x00},
+    {0x3556, 0x00},
+    {0x3557, 0x00},
+    {0x3558, 0x00},
+    {0x3559, 0x1f},
+    {0x355a, 0x1f},
+    {0x35ba, 0x0f},
+    {0x366a, 0x00},
+    {0x366b, 0x00},
+    {0x366c, 0x00},
+    {0x366d, 0x00},
+    {0x3a41, 0x10},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+    //expo
+    {0x300d, 0x10},//MSB
+    {0x300c, 0x39},
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x03},//??
+    {0xffff, 0x07},//delay >=7ms
+
+    //setting3
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+
+};
+
+const I2C_ARRAY Sensor_init_table_4lane_4P8M30fps[] =
+{
+//Linear mode, MIPI clock 576Mbps, VMAX 4004 @30fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xC0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x5f},
+    {0x3135, 0x00},
+    {0x3136, 0x47},
+    {0x3137, 0x00},
+    {0x3138, 0x27},
+    {0x3139, 0x00},
+    {0x313a, 0x27},
+    {0x313b, 0x00},
+    {0x313c, 0x27},
+    {0x313d, 0x00},
+    {0x313e, 0x97},
+    {0x313f, 0x00},
+    {0x3140, 0x27},
+    {0x3141, 0x00},
+    {0x3142, 0x1f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+
+//mode registers 4P8M@30fps
+    {0x3004, 0x00},//shutter and gain
+    {0x3005, 0x07},
+    {0x3006, 0x00},
+    {0x3007, 0xa2},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x10},
+    {0x301A, 0x00},
+    {0x3032, 0x08},
+    {0x3033, 0x00},
+
+    {0x3037, 0x01},
+    {0x3038, 0xbc},
+    {0x3039, 0x01},//??
+    {0x303a, 0x5c},
+    {0x303b, 0x0d},
+
+    {0x3041, 0x30},
+    {0x3042, 0x08},
+    {0x3043, 0x01},
+
+    {0x306b, 0x07},
+    {0x30dd, 0x01},
+    {0x30de, 0xfc},
+    {0x30df, 0x00},
+    {0x30e0, 0x7e},//inverted 0x82
+    {0x30e1, 0x00},//inverted 0x0f
+    {0x30e2, 0x00},
+    {0x30e9, 0x00},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x58},//HMAX
+    {0x30f7, 0x02},
+    {0x30f8, 0xa4},//VMAX
+    {0x30f9, 0x0f},
+    {0x30fa, 0x00},//
+    {0x3130, 0xb2},
+    {0x3131, 0x06},
+    {0x3132, 0xa2},
+    {0x3133, 0x06},
+
+    {0x3342, 0xff},
+    {0x3343, 0x01},
+    {0x3344, 0xff},
+    {0x3345, 0x01},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0f},
+    {0x3554, 0x00},
+    {0x3555, 0x00},
+    {0x3556, 0x00},
+    {0x3557, 0x00},
+    {0x3558, 0x00},
+    {0x3559, 0x1f},
+    {0x355a, 0x1f},
+    {0x35ba, 0x0f},
+    {0x366a, 0x00},
+    {0x366b, 0x00},
+    {0x366c, 0x00},
+    {0x366d, 0x00},
+    {0x3a41, 0x10},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+    //expo
+    {0x300d, 0x0e},//MSB
+    {0x300c, 0x10},
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x03},//??
+    {0xffff, 0x07},//delay >=7ms
+
+    //setting3
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+
+};
+
+const I2C_ARRAY Sensor_init_table_4lane_3P6M30fps[] =
+{
+//Linear mode, MIPI clock 576Mbps, VMAX 4620 @30fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xC0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x5f},
+    {0x3135, 0x00},
+    {0x3136, 0x47},
+    {0x3137, 0x00},
+    {0x3138, 0x27},
+    {0x3139, 0x00},
+    {0x313a, 0x27},
+    {0x313b, 0x00},
+    {0x313c, 0x27},
+    {0x313d, 0x00},
+    {0x313e, 0x97},
+    {0x313f, 0x00},
+    {0x3140, 0x27},
+    {0x3141, 0x00},
+    {0x3142, 0x1f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+
+//mode registers 3P6M@30fps
+    {0x3004, 0x00},//shutter and gain
+    {0x3005, 0x07},
+    {0x3006, 0x00},
+    {0x3007, 0xa2},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x10},
+    {0x301A, 0x00},
+    {0x3032, 0x08},
+    {0x3033, 0x00},
+
+    {0x3037, 0x01},
+    {0x3038, 0x7c},
+    {0x3039, 0x02},//??
+    {0x303a, 0x9c},
+    {0x303b, 0x0c},
+
+    {0x3041, 0x30},
+    {0x3042, 0x08},
+    {0x3043, 0x01},
+
+    {0x306b, 0x07},
+    {0x30dd, 0x01},
+    {0x30de, 0x68},
+    {0x30df, 0x01},
+    {0x30e0, 0xb4},//inverted 0x4c
+    {0x30e1, 0x00},//inverted 0x0f
+    {0x30e2, 0x00},
+    {0x30e9, 0x00},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x08},//HMAX
+    {0x30f7, 0x02},
+    {0x30f8, 0x0c},//VMAX
+    {0x30f9, 0x12},
+    {0x30fa, 0x00},//
+    {0x3130, 0xda},
+    {0x3131, 0x05},
+    {0x3132, 0xca},
+    {0x3133, 0x05},
+
+    {0x3342, 0xff},
+    {0x3343, 0x01},
+    {0x3344, 0xff},
+    {0x3345, 0x01},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0f},
+    {0x3554, 0x00},
+    {0x3555, 0x00},
+    {0x3556, 0x00},
+    {0x3557, 0x00},
+    {0x3558, 0x00},
+    {0x3559, 0x1f},
+    {0x355a, 0x1f},
+    {0x35ba, 0x0f},
+    {0x366a, 0x00},
+    {0x366b, 0x00},
+    {0x366c, 0x00},
+    {0x366d, 0x00},
+    {0x3a41, 0x10},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+    //expo
+    {0x300d, 0x10},//MSB
+    {0x300c, 0x39},
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x03},//??
+    {0xffff, 0x07},//delay >=7ms
+
+    //setting3
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+
+};
+
+const I2C_ARRAY Sensor_init_table_4lane_2M60fps[] =
+{
+//Linear mode, MIPI clock 576Mbps, VMAX 2310 @60fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xC0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x5f},
+    {0x3135, 0x00},
+    {0x3136, 0x47},
+    {0x3137, 0x00},
+    {0x3138, 0x27},
+    {0x3139, 0x00},
+    {0x313a, 0x27},
+    {0x313b, 0x00},
+    {0x313c, 0x27},
+    {0x313d, 0x00},
+    {0x313e, 0x97},
+    {0x313f, 0x00},
+    {0x3140, 0x27},
+    {0x3141, 0x00},
+    {0x3142, 0x1f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+
+//mode registers 2M@60fps
+    {0x3004, 0x02},//shutter and gain
+    {0x3005, 0x27},
+    {0x3006, 0x00},
+    {0x3007, 0x11},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x10},
+    {0x301A, 0x00},
+    {0x3032, 0x08},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x02},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x30},
+    {0x3042, 0x08},
+    {0x3043, 0x01},
+
+    {0x306b, 0x07},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},//
+    {0x30e1, 0x00},//
+    {0x30e2, 0x02},
+    {0x30e9, 0x00},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x08},//HMAX
+    {0x30f7, 0x02},
+    {0x30f8, 0x06},//VMAX
+    {0x30f9, 0x09},
+    {0x30fa, 0x00},//
+    {0x3130, 0x4e},
+    {0x3131, 0x04},
+    {0x3132, 0x46},
+    {0x3133, 0x04},
+
+    {0x3342, 0xff},
+    {0x3343, 0x01},
+    {0x3344, 0xff},
+    {0x3345, 0x01},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0f},
+    {0x3554, 0x00},
+    {0x3555, 0x00},
+    {0x3556, 0x00},
+    {0x3557, 0x00},
+    {0x3558, 0x00},
+    {0x3559, 0x1f},
+    {0x355a, 0x1f},
+    {0x35ba, 0x0f},
+    {0x366a, 0x00},
+    {0x366b, 0x00},
+    {0x366c, 0x00},
+    {0x366d, 0x00},
+    {0x3a41, 0x08},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+    //expo
+    {0x300d, 0x10},//MSB
+    {0x300c, 0x39},
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x03},//??
+    {0xffff, 0x07},//delay >=7ms
+
+    //setting3
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+
+};
+
+const I2C_ARRAY Sensor_init_table_4lane_4K30fps[] =
+{
+//Linear mode, MIPI clock 720Mbps, VMAX 4620 @20fps
+    {0x3000, 0x12},   //standby
+    {0x3120, 0xF0},
+    {0x3121, 0x00},
+    {0x3122, 0x02},
+    {0x3123, 0x01},//
+    {0x3129, 0x9C},
+    {0x312a, 0x02},
+    {0x312d, 0x02},
+    {0x3ac4, 0x01},//
+    {0x310b, 0x00},
+    {0x304c, 0x00},
+    {0x304d, 0x03},
+    {0x331c, 0x1a},
+    {0x331d, 0x00},
+    {0x3502, 0x02},
+    {0x3529, 0x0e},
+    {0x352a, 0x0e},
+    {0x352b, 0x0e},
+    {0x3538, 0x0e},
+    {0x3539, 0x0e},
+    {0x3553, 0x00},
+    {0x357d, 0x05},
+    {0x357f, 0x05},
+    {0x3581, 0x04},
+    {0x3583, 0x76},
+    {0x3587, 0x01},
+    {0x35bb, 0x0e},
+    {0x35bc, 0x0e},
+    {0x35bd, 0x0e},
+    {0x35be, 0x0e},
+    {0x35bf, 0x0e},
+    {0x366e, 0x00},
+    {0x366f, 0x00},
+    {0x3670, 0x00},
+    {0x3671, 0x00},
+    {0x30ee, 0x01},
+    {0x3304, 0x32},
+    {0x3305, 0x00},
+    {0x3306, 0x32},
+    {0x3307, 0x00},
+    {0x3590, 0x32},
+    {0x3591, 0x00},
+    {0x3686, 0x32},
+    {0x3687, 0x00},
+    {0x3134, 0x77},
+    {0x3135, 0x00},
+    {0x3136, 0x67},
+    {0x3137, 0x00},
+    {0x3138, 0x37},
+    {0x3139, 0x00},
+    {0x313a, 0x37},
+    {0x313b, 0x00},
+    {0x313c, 0x37},
+    {0x313d, 0x00},
+    {0x313e, 0xDF},
+    {0x313f, 0x00},
+    {0x3140, 0x37},
+    {0x3141, 0x00},
+    {0x3142, 0x2f},
+    {0x3143, 0x00},
+    {0x3144, 0x0f},
+    {0x3145, 0x00},
+    {0x3a86, 0x47},
+    {0x3a87, 0x00},
+//mode registers 15fps
+    {0x3004, 0x01},//shutter and gain
+    {0x3005, 0x01},
+    {0x3006, 0x00},
+    {0x3007, 0x02},
+
+    {0x300E, 0x00},
+    {0x300F, 0x00},
+    {0x3019, 0x10},
+    {0x301A, 0x00},
+    {0x3032, 0x08},
+    {0x3033, 0x00},
+
+    {0x3037, 0x00},
+    {0x3038, 0x00},
+    {0x3039, 0x00},//??
+    {0x303a, 0x00},
+    {0x303b, 0x00},
+
+    {0x3041, 0x30},
+    {0x3042, 0x08},
+    {0x3043, 0x01},
+
+    {0x306b, 0x05},
+    {0x30dd, 0x00},
+    {0x30de, 0x00},
+    {0x30df, 0x00},
+    {0x30e0, 0x00},
+    {0x30e1, 0x00},
+    {0x30e2, 0x01},
+    {0x30e9, 0x00},
+
+    {0x30ee, 0x01},
+    {0x30f6, 0x08},//HMAX
+    {0x30f7, 0x02},
+    {0x30f8, 0x0c},//VMAX
+    {0x30f9, 0x12},
+    {0x30fa, 0x00},//
+    {0x3130, 0x86},
+    {0x3131, 0x08},
+    {0x3132, 0x7e},
+    {0x3133, 0x08},
+
+    {0x3342, 0x0a},
+    {0x3343, 0x00},
+    {0x3344, 0x16},
+    {0x3345, 0x00},
+
+    {0x33a6, 0x01},
+    {0x3528, 0x0e},
+    {0x3554, 0x1f},
+    {0x3555, 0x01},
+    {0x3556, 0x01},
+    {0x3557, 0x01},
+    {0x3558, 0x01},
+    {0x3559, 0x00},
+    {0x355a, 0x00},
+    {0x35ba, 0x0e},
+    {0x366a, 0x1b},
+    {0x366b, 0x1a},
+    {0x366c, 0x19},
+    {0x366d, 0x17},
+    {0x3a41, 0x08},
+   // {0x3045, 0x28},//black level
+    {0xffff, 0x0a},//delay >=10ms
+
+    //{0x300a, 0x80},//analog gain yc add
+   // {0x300b, 0x00},//yc add
+    //{0x3012, 0x05},//digital gain
+
+    //{0x300d, 0xff},//MSB
+    //{0x300c, 0x02},
+
+    //{0x300c, 0x08},//yc add
+    //{0x300d, 0x01},//yc add
+
+    //expo
+    {0x300d, 0x10},//MSB
+    {0x300c, 0x3e},
+    //setting 2
+    {0x3000, 0x00},
+    {0x303e, 0x02},//??
+    {0xffff, 0x07},//delay >=7ms
+
+   // {0x303c, 0x11},//test pattern
+   // {0x303d, 0x0a},
+
+    //setting3
+
+    {0x30f4, 0x00},
+    {0x3018, 0xa2},
+    //{0xffff, 0x60},//delay >=96ms
+    //{0x312e, 0x01},
+    //{0x3aa2, 0x01},
+
+   // {0x3001, 0x06}, // ?��?MIPI 2lane Mode Change
+};
+
+
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@                                                                                    //
+//                 @@                                                                                    //
+//             @@@                                                                                      //
+//       @       @@                                                                                    //
+//         @@@@                                                                                        //
+//                                                                                                          //
+//      Step 3 --  complete camera features                                              //
+//                                                                                                         //
+//                                                                                                         //
+//  camera set EV, MWB, orientation, contrast, sharpness                          //
+//   , saturation, and Denoise can work correctly.                                     //
+//                                                                                                          //
+/////////////////////////////////////////////////////////////////
+
+
+const I2C_ARRAY mirr_flip_table[] =
+{
+    {0x301a, 0x00},//M0F0
+    {0x301a, 0x00},//M1F0
+    {0x301a, 0x01},//M0F1
+    {0x301a, 0x01},//M1F1
+
+};
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+const I2C_ARRAY gain_reg[] = {
+    {0x300b, 0x00},//high 10~8bit, analog gain
+    {0x300a, 0x10},//low byte
+    {0x3012, 0x10},//low bit 0~2
+};
+
+static CUS_GAIN_GAP_ARRAY gain_gap_compensate[16] = {  //compensate  gain gap
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0},
+        {0, 0}
+};
+
+const I2C_ARRAY expo_reg[] = {
+    {0x300d, 0x00},//MSB
+    {0x300c, 0x00},
+};
+
+const I2C_ARRAY expo_shr_dol1_reg[] =
+{ //SEL
+    {0x302F, 0x00},//MSB
+    {0x302E, 0x04},
+};
+const I2C_ARRAY expo_rhs1_reg[] =
+{ //SEL
+    {0x3033, 0x00},//MSB
+    {0x3032, 0x08},
+};
+const I2C_ARRAY expo_shr_dol2_reg[] =
+{ //LEF
+    {0x3031, 0x05},//MSB
+    {0x3030, 0x43},
+};
+
+const I2C_ARRAY vts_reg[] = {
+    {0x30fa, 0x00},//bit0-3-->MSB
+    {0x30f9, 0x09},
+    {0x30f8, 0x06},
+};
+
+I2C_ARRAY PatternTbl[] = {
+    //pattern mode
+    {0x303c, 0x11},//test pattern
+    {0x303d, 0x0a},
+};
+
+CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+int cus_camsensor_release_handle(ms_cus_sensor *handle);
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    //Sensor power on sequence
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    //sensor_if->SetCSI_VC0HSmode(handle,PACKET_FOOTER_EDGE);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 1);
+    }
+
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    SENSOR_UDELAY(20);
+
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    SENSOR_UDELAY(20);
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    SENSOR_UDELAY(20);
+
+    SENSOR_DMSG("[%s] reset high\n", __FUNCTION__);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+
+    sensor_if->MCLK(idx, 1, handle->mclk);
+    SENSOR_UDELAY(20);
+
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 0);
+    }
+
+    params->cur_orien = CUS_ORIT_M0F0;
+
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8) table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>2) return FAIL;
+
+      if( SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+	 break;
+      else
+        continue;
+
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+      if( id_from_sensor[i].data != Sensor_id_table[i].data )
+        return FAIL;
+      *id = id_from_sensor[i].data;
+    }
+
+
+    SENSOR_DMSG("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    return SUCCESS;
+}
+
+static int imx274_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+    int i;
+  switch(mode)
+  {
+  case 1:
+    PatternTbl[0].data |= 0x11; //enable
+  break;
+  case 0:
+    PatternTbl[0].data &= 0x00; //disable
+  break;
+  default:
+    PatternTbl[0].data &= 0x00; //disable
+  break;
+  }
+
+  for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+  {
+    if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+    {
+      //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+      return FAIL;
+    }
+  }
+
+  return SUCCESS;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain);
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+
+static int pCus_init_mipi4lane_linear_4K15fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4K15fps);i++)
+    {
+        if(Sensor_init_table_4lane_4K15fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4K15fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4K15fps[i].reg, Sensor_init_table_4lane_4K15fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_4K20fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4K20fps);i++)
+    {
+        if(Sensor_init_table_4lane_4K20fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4K20fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4K20fps[i].reg, Sensor_init_table_4lane_4K20fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_5M30fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_5M30fps);i++)
+    {
+        if(Sensor_init_table_4lane_5M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_5M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_5M30fps[i].reg, Sensor_init_table_4lane_5M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_4P8M30fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4P8M30fps);i++)
+    {
+        if(Sensor_init_table_4lane_4P8M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4P8M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4P8M30fps[i].reg, Sensor_init_table_4lane_4P8M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_3P6M30fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_3P6M30fps);i++)
+    {
+        if(Sensor_init_table_4lane_3P6M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_3P6M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_3P6M30fps[i].reg, Sensor_init_table_4lane_3P6M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_2M60fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_2M60fps);i++)
+    {
+        if(Sensor_init_table_4lane_2M60fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_2M60fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_2M60fps[i].reg, Sensor_init_table_4lane_2M60fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+
+static int pCus_init_mipi4lane_linear_4K30fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4K30fps);i++)
+    {
+        if(Sensor_init_table_4lane_4K30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4K30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4K30fps[i].reg, Sensor_init_table_4lane_4K30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    pCus_SetOrien(handle, params->cur_orien);
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+
+static int pCus_init_mipi4lane_HDR_DOL_4k15fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    int i,cnt=0;
+
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane_4k15fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg==0xffff)
+        {
+            //MsSleep(RTK_MS_TO_TICK(1));//usleep(1000*Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data);
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            SENSOR_DMSG("reg =  %x, data = %x\n", Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg, Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data);
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg,Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                 SENSOR_DMSG("Sensor_init_table_HDR_DOL_4lane_4k15fps -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+            //SensorReg_Read( Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg, &sen_data );
+            //UartSendTrace("IMX274 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg, Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data, sen_data);
+        }
+    }
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+
+    //MSG("[%s:%d]Sensor init success!!\n", __FUNCTION__, __LINE__);
+    return SUCCESS;
+}
+
+
+static int pCus_init_mipi4lane_HDR_DOL_4k20fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    int i,cnt=0;
+
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane_4k20fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane_4k20fps[i].reg==0xffff)
+        {
+            //MsSleep(RTK_MS_TO_TICK(1));//usleep(1000*Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data);
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane_4k20fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            SENSOR_DMSG("reg =  %x, data = %x\n", Sensor_init_table_HDR_DOL_4lane_4k20fps[i].reg, Sensor_init_table_HDR_DOL_4lane_4k20fps[i].data);
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane_4k20fps[i].reg,Sensor_init_table_HDR_DOL_4lane_4k20fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                 SENSOR_DMSG("Sensor_init_table_HDR_DOL_4lane_4k20fps -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+            //SensorReg_Read( Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg, &sen_data );
+            //UartSendTrace("IMX274 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg, Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data, sen_data);
+        }
+    }
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+
+    //MSG("[%s:%d]Sensor init success!!\n", __FUNCTION__, __LINE__);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_HDR_DOL_4k30fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    int i,cnt=0;
+
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane_4k30fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane_4k30fps[i].reg==0xffff)
+        {
+            //MsSleep(RTK_MS_TO_TICK(1));//usleep(1000*Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data);
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane_4k30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            SENSOR_DMSG("reg =  %x, data = %x\n", Sensor_init_table_HDR_DOL_4lane_4k30fps[i].reg, Sensor_init_table_HDR_DOL_4lane_4k30fps[i].data);
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane_4k30fps[i].reg,Sensor_init_table_HDR_DOL_4lane_4k30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                 SENSOR_DMSG("Sensor_init_table_HDR_DOL_4lane_4k25fps -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+            //SensorReg_Read( Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg, &sen_data );
+            //UartSendTrace("IMX274 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane_4k15fps[i].reg, Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data, sen_data);
+        }
+    }
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+
+    //MSG("[%s:%d]Sensor init success!!\n", __FUNCTION__, __LINE__);
+    return SUCCESS;
+}
+
+
+static int pCus_init_mipi4lane_HDR_DOL_2M30fps(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    int i,cnt=0;
+
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane_2M30fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane_2M30fps[i].reg==0xffff)
+        {
+            //MsSleep(RTK_MS_TO_TICK(1));//usleep(1000*Sensor_init_table_HDR_DOL_4lane_4k15fps[i].data);
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane_2M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            //SENSOR_IMSG("reg =  %x, data = %x\n", Sensor_init_table_HDR_DOL_4lane_2M30fps[i].reg, Sensor_init_table_HDR_DOL_4lane_2M30fps[i].data);
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane_2M30fps[i].reg,Sensor_init_table_HDR_DOL_4lane_2M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                 SENSOR_DMSG("Sensor_init_table_HDR_DOL_4lane_2M30fps -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+            //SensorReg_Read( Sensor_init_table_HDR_DOL_4lane_2M30fps[i].reg, &sen_data );
+            //UartSendTrace("IMX274 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane_2M30fps[i].reg, Sensor_init_table_HDR_DOL_4lane_2M30fps[i].data, sen_data);
+        }
+    }
+
+    params->tVts_reg[0].data =(u16)((params->expo.vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((params->expo.vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((params->expo.vts >> 0) & 0x00ff);
+
+    //MSG("[%s:%d]Sensor init success!!\n", __FUNCTION__, __LINE__);
+    return SUCCESS;
+}
+
+
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    handle->data_prec   = SENSOR_DATAPREC;
+    switch (res_idx) {
+        case 0: //"3840x2160@15fps"
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4K15fps;
+            vts_30fps  = 4486;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 15;
+            Preview_line_period  = 14861;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            break;
+        case 1: //"3840x2160@20fps"
+            handle->video_res_supported.ulcur_res = 1;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4K20fps;
+            vts_30fps = 4500;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 20;
+            Preview_line_period  = 11111;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            break;
+        case 2: //"2592x1944@30fps"
+            handle->video_res_supported.ulcur_res = 2;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_5M30fps;
+            vts_30fps = 4620;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 7222;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0x36;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0xF;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0xCA;
+            break;
+        case 3: //"2944x1656@30fps"
+            handle->video_res_supported.ulcur_res = 3;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4P8M30fps;
+            vts_30fps = 4004;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 8333;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0x7E;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0xF;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0x82;
+            break;
+        case 4: //"2560x1440@30fps"
+            handle->video_res_supported.ulcur_res = 4;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_3P6M30fps;
+            vts_30fps = 4620;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 7222;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0xB4;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0xF;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0x4C;
+            break;
+        case 5: //"1920x1080@60fps"
+            handle->video_res_supported.ulcur_res = 5;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_2M60fps;
+            vts_30fps = 2310;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 60;
+            Preview_line_period  = 7222;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            break;
+        case 6: //"3840x2160@30fps"
+            handle->video_res_supported.ulcur_res = 6;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4K30fps;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            vts_30fps = 4620;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 7215;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            break;
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            if (handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num == 1) {
+                handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL_4k15fps;
+                handle->pCus_sensor_SetAEUSecs  = pCus_SetAEUSecsHDR_DOL_SEF;
+            }
+            vts_30fps_HDR_DOL = (2310+Preview_CROP_START_Y_DOL);
+            params->expo.vts = vts_30fps_HDR_DOL;
+            params->expo.fps = 15;
+            Preview_line_period_HDR_DOL = 28879;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            params->vts_to_rhs1 = 2310;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            if (handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num == 1) {
+                handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL_2M30fps;
+                handle->pCus_sensor_SetAEUSecs  = pCus_SetAEUSecsHDR_DOL_SEF_Binning;
+            }
+            vts_30fps_HDR_DOL = 2310;
+            params->expo.vts = vts_30fps_HDR_DOL;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL = 14430;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            params->vts_to_rhs1 = 2310;
+            break;
+        case 2:
+            handle->video_res_supported.ulcur_res = 2;
+            if (handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num == 1) {
+                handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL_4k20fps;
+                handle->pCus_sensor_SetAEUSecs  = pCus_SetAEUSecsHDR_DOL_SEF;
+            }
+            vts_30fps_HDR_DOL = (2500+Preview_CROP_START_Y_DOL);
+            params->expo.vts = vts_30fps_HDR_DOL;
+            params->expo.fps = 20;
+            Preview_line_period_HDR_DOL = 19936;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            params->vts_to_rhs1 = 2360; //fix rhs1, align to res 0
+            break;
+        case 3:
+            handle->video_res_supported.ulcur_res = 3;
+            if (handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num == 1) {
+                handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL_4k30fps;
+                handle->pCus_sensor_SetAEUSecs  = pCus_SetAEUSecsHDR_DOL_SEF;
+            }
+            vts_30fps_HDR_DOL = (2275+Preview_CROP_START_Y_DOL);
+            params->expo.vts = vts_30fps_HDR_DOL;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL = 14652;
+            params->vwinpos_nor[0].reg = 0x30E1;
+            params->vwinpos_nor[0].data = 0;
+            params->vwinpos_nor[1].reg = 0x30E0;
+            params->vwinpos_nor[1].data = 0;
+            params->vwinpos_inv[0].reg = 0x30E1;
+            params->vwinpos_inv[0].data = 0;
+            params->vwinpos_inv[1].reg = 0x30E0;
+            params->vwinpos_inv[1].data = 0;
+            params->vts_to_rhs1 = 2275;
+            break;
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    short sen_data = 0;
+
+    SensorReg_Read(0x301a, &sen_data);//always success now
+
+    SENSOR_DMSG("mirror:%x\r\n", sen_data & 0x01);
+    switch(sen_data & 0x01)
+    {
+        case 0x00:
+            *orit = CUS_ORIT_M0F0;
+        break;
+        case 0x01:
+            *orit = CUS_ORIT_M0F1;
+        break;
+        default:
+            *orit = CUS_ORIT_M0F0;
+        break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    int table_length = ARRAY_SIZE(mirr_flip_table);
+    int seg_length=table_length/4;
+    int i,j;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            for(i=0,j=0;i<seg_length;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                params->cur_orien = CUS_ORIT_M0F0;
+            }
+            SensorRegArrayW((I2C_ARRAY*)params->vwinpos_nor, ARRAY_SIZE(params->vwinpos_nor));
+            break;
+
+        case CUS_ORIT_M1F0:
+            for(i=seg_length,j=0;i<seg_length*2;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                params->cur_orien = CUS_ORIT_M1F0;
+            }
+            SensorRegArrayW((I2C_ARRAY*)params->vwinpos_nor, ARRAY_SIZE(params->vwinpos_nor));
+            break;
+
+        case CUS_ORIT_M0F1:
+            for(i=seg_length*2,j=0;i<seg_length*3;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                params->cur_orien = CUS_ORIT_M0F1;
+            }
+            SensorRegArrayW((I2C_ARRAY*)params->vwinpos_inv, ARRAY_SIZE(params->vwinpos_inv));
+            break;
+
+        case CUS_ORIT_M1F1:
+            for(i=seg_length*3,j=0;i<seg_length*4;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                params->cur_orien = CUS_ORIT_M1F1;
+            }
+             SensorRegArrayW((I2C_ARRAY*)params->vwinpos_inv, ARRAY_SIZE(params->vwinpos_inv));
+            break;
+
+        default :
+            for(i=0,j=0;i<seg_length;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                params->cur_orien = CUS_ORIT_M0F0;
+            }
+            SensorRegArrayW((I2C_ARRAY*)params->vwinpos_nor, ARRAY_SIZE(params->vwinpos_nor));
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*(max_fps*1000))/fps;
+
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    pCus_SetAEUSecs(handle, params->expo.expo_lef_us);
+    params->dirty = true; //reg need to update = true;
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_SEF(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_SEF(ms_cus_sensor *handle, u32 fps)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*(max_fps*1000))/fps;
+    }else{
+      //params->expo.vts=vts_30fps;
+      //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    pCus_SetAEUSecsHDR_DOL_SEF(handle, params->expo.expo_sef_us);
+    params->dirty = true; //reg need to update = true;
+    return SUCCESS;
+}
+
+
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap) {
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty)
+            {
+                SensorReg_Write(0x302d,1);
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                SensorReg_Write(0x302d,0);
+                params->dirty = false;
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //ISensorIfAPI2 *sensor_if1 = handle->sensor_if_api2;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty)
+            {
+                SensorReg_Write(0x302d, 1);
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_shr_dol2_reg, ARRAY_SIZE(expo_shr_dol2_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_shr_dol1_reg, ARRAY_SIZE(expo_shr_dol1_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_rhs1_reg, ARRAY_SIZE(expo_rhs1_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                SensorReg_Write(0x302d, 0);
+                params->dirty = false;
+            }
+            break;
+        default :
+             break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs_hdr_dol_lef(ms_cus_sensor *handle, u32 *us)
+{
+    *us = 0;
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_SEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+   // imx274_params *params = (imx274_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, vts = 0, shr_dol2 = 0;
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    // us = 1000000/30;
+    //lines = us/Preview_line_period_HDR_DOL;
+    lines = (1000 * us) / Preview_line_period_HDR_DOL;
+    if (lines > params->expo.vts - 4) {
+        vts = lines + 4;
+    }
+    else{
+      vts = params->expo.vts;
+    }
+
+   // lines=us/Preview_line_period_HDR_DOL;
+    SENSOR_DMSG("[%s] us %ld, lines %ld, vts %ld\n", __FUNCTION__,
+                us,
+                lines,
+                params->expo.vts
+                );
+
+    shr_dol2 = vts - lines;
+
+    params->tExpo_shr_dol2_reg[0].data = (shr_dol2 >> 8) & 0x00ff;
+    params->tExpo_shr_dol2_reg[1].data = (shr_dol2 >> 0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x000f;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    //SensorReg_Write(0x3001,1);
+    //SensorRegArrayW((I2C_ARRAY*)expo_SHS2_reg, ARRAY_SIZE(expo_SHS2_reg));
+    //SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+    //SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+    //SENSOR_EMSG("[LEF, us:%d, lines:%d, ", us, lines);
+    //SENSOR_EMSG("vts:%d, shr_dol2:%d]\n", vts, shr_dol2);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEGain_hdr_dol_lef(ms_cus_sensor *handle, u32* gain)
+{
+    *gain = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, vts = 0;
+    u32 rhs1 = 0, shr_dol1 = 0, shr_dol2 = 0;
+    u32 max_rhs1 = 0;
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    params->expo.expo_sef_us = us;
+
+    // us = 1000000/30;
+    //lines = us/Preview_line_period_HDR_DOL;
+    lines = (1000 * us) / Preview_line_period_HDR_DOL;
+    vts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    shr_dol2 = ((params->tExpo_shr_dol2_reg[0].data << 8) | (params->tExpo_shr_dol2_reg[1].data << 0));
+
+    max_rhs1 = params->vts_to_rhs1 - 2198 - Preview_CROP_START_Y_DOL;
+
+    //rhs1 = ((params->tExpo_rhs1_reg[0].data << 8) | (params->tExpo_rhs1_reg[1].data << 0));
+    rhs1 = max_rhs1;
+
+    if((rhs1 - 6) < lines){
+        shr_dol1 = 6;
+    }
+    else if((rhs1 <= max_rhs1) && (rhs1 <= shr_dol2 - 6)){
+        shr_dol1 = rhs1 - lines;
+        if((shr_dol1 < 6) || (shr_dol1 > (rhs1 - 2))){ //Check boundary
+            //shs1 = 0;
+            //UartSendTrace("\n\n[SEF NG1]\n");
+        }
+    }
+    else{
+        //UartSendTrace("\n\n[SEF NG2]\n");
+    }
+
+    //SENSOR_EMSG("[SEF, us:%d, lines:%d, ", us, lines);
+    //SENSOR_EMSG("vts:%d, shr_dol2:%d, ", vts, shr_dol2);
+    //SENSOR_EMSG("rhs1:%d, shr_dol1:%d]\n", rhs1, shr_dol1);
+
+    params->tExpo_shr_dol1_reg[0].data = (shr_dol1 >> 8) & 0x00ff;
+    params->tExpo_shr_dol1_reg[1].data = (shr_dol1 >> 0) & 0x00ff;
+
+    params->tExpo_rhs1_reg[0].data = (rhs1 >> 8) & 0x00ff;
+    params->tExpo_rhs1_reg[1].data = (rhs1 >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF_Binning(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, vts = 0;
+    u32 rhs1 = 0, shr_dol1 = 0, shr_dol2 = 0;
+    u32 max_rhs1 = 0;
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    // us = 1000000/30;
+    //lines = us/Preview_line_period_HDR_DOL;
+    lines = (1000 * us) / Preview_line_period_HDR_DOL;
+    vts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    shr_dol2 = ((params->tExpo_shr_dol2_reg[0].data << 8) | (params->tExpo_shr_dol2_reg[1].data << 0));
+
+    max_rhs1 = params->vts_to_rhs1 - 2198 - Preview_CROP_START_Y_DOL;
+
+    //rhs1 = ((params->tExpo_rhs1_reg[0].data << 8) | (params->tExpo_rhs1_reg[1].data << 0));
+    rhs1 = max_rhs1;
+
+    if((rhs1 - 4) < lines){
+        shr_dol1 = 4;
+    }
+    else if((rhs1 <= max_rhs1) && (rhs1 <= shr_dol2 - 4)){
+        shr_dol1 = rhs1 - lines;
+        if((shr_dol1 < 4) || (shr_dol1 > (rhs1 - 2))){ //Check boundary
+            //shs1 = 0;
+            //UartSendTrace("\n\n[SEF NG1]\n");
+        }
+    }
+    else{
+        //UartSendTrace("\n\n[SEF NG2]\n");
+    }
+
+    //SENSOR_EMSG("[SEF, us:%d, lines:%d, ", us, lines);
+    //SENSOR_EMSG("vts:%d, shr_dol2:%d, ", vts, shr_dol2);
+    //SENSOR_EMSG("rhs1:%d, shr_dol1:%d]\n", rhs1, shr_dol1);
+
+    params->tExpo_shr_dol1_reg[0].data = (shr_dol1 >> 8) & 0x00ff;
+    params->tExpo_shr_dol1_reg[1].data = (shr_dol1 >> 0) & 0x00ff;
+
+    params->tExpo_rhs1_reg[0].data = (rhs1 >> 8) & 0x00ff;
+    params->tExpo_rhs1_reg[1].data = (rhs1 >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 lines = 0;
+    //int rc = SensorRegArrayR((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+    lines |= (u32)(params->tExpo_reg[0].data&0xff)<<8;
+    lines |= (u32)(params->tExpo_reg[1].data&0xff)<<0;
+   // lines >>= 4;
+   // *us = (lines+dummy) * params->expo.us_per_line;
+    //*us = lines;//(lines*Preview_line_period);
+    *us = lines*Preview_line_period/1000;
+    SENSOR_DMSG("[%s] sensor expo lines/us %ld,%ld us\n", __FUNCTION__, lines, *us);
+    //return rc;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, vts = 0;
+    imx274_params *params = (imx274_params *)handle->private_data;
+
+    params->expo.expo_lef_us = us;
+    lines=(1000*us)/Preview_line_period;
+
+    if (lines >params->expo.vts-12) {
+        vts = lines +12;
+    }
+    else
+        vts=params->expo.vts;
+
+#if 0
+    // lines=us/Preview_line_period;
+    SENSOR_DMSG("[%s] us %ld, lines %ld, vts %ld\n", __FUNCTION__,
+    us,
+    lines,
+    params->expo.vts
+    );
+#endif
+    lines=vts-lines;
+
+    params->tExpo_reg[0].data =(u16)((lines>>8) & 0x00ff);
+    params->tExpo_reg[1].data =(u16)((lines>>0) & 0x00ff);
+
+    params->tVts_reg[0].data =(u16)((vts >> 16) & 0x000f);
+    params->tVts_reg[1].data = (u16)((vts >> 8) & 0x00ff);
+    params->tVts_reg[2].data = (u16)((vts >> 0) & 0x00ff);
+
+    //SensorReg_Write(0x302d,1);
+    //SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+    //SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+    //SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+    params->dirty = true;
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    //u16  temp_gain;
+    //double  temp_gain_double;
+
+    *gain=params->expo.final_gain;
+    SENSOR_DMSG("[%s] get gain/regL/regH (1024=1X)= %d/0x%x/0x%x\n", __FUNCTION__, *gain, params->tGain_reg[0].data, params->tGain_reg[1].data);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u16 gain16;
+    //double gain_double;
+
+    params->expo.final_gain = gain;
+    if(gain<SENSOR_MIN_GAIN)
+        gain=SENSOR_MIN_GAIN;
+    else if(gain>=SENSOR_MAX_GAIN)
+        gain=SENSOR_MAX_GAIN;
+
+    gain16=(u16)(2048-((2048*1024)/gain));
+    //gain16=(u16)(gain_double*10);
+
+    params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+    params->tGain_reg[1].data=gain16&0xff;//LSB
+
+    SENSOR_DMSG("[%s] set gain/reg0/reg1=%d/0x%x/0x%x\n", __FUNCTION__, gain, params->tGain_reg[0].data, params->tGain_reg[1].data);
+    return SUCCESS;
+
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain)
+{
+    //extern DBG_ITEM Dbg_Items[DBG_TAG_MAX];
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 i;
+    //double gain_double;
+    CUS_GAIN_GAP_ARRAY* Sensor_Gain_Linearity;
+    u16 gain16;
+
+    params->expo.final_gain = gain;
+    if(gain<SENSOR_MIN_GAIN)
+        gain=SENSOR_MIN_GAIN;
+    else if(gain>=SENSOR_MAX_GAIN)
+        gain=SENSOR_MAX_GAIN;
+
+    //gain_double=(double)gain;
+    Sensor_Gain_Linearity = gain_gap_compensate;
+
+    for(i = 0; i < sizeof(gain_gap_compensate)/sizeof(CUS_GAIN_GAP_ARRAY); i++){
+        //LOGD("GAP:%x %x\r\n",Sensor_Gain_Linearity[i].gain, Sensor_Gain_Linearity[i].offset);
+
+        if (Sensor_Gain_Linearity[i].gain == 0)
+            break;
+        if((gain>Sensor_Gain_Linearity[i].gain) && (gain < (Sensor_Gain_Linearity[i].gain + Sensor_Gain_Linearity[i].offset))){
+              gain=Sensor_Gain_Linearity[i].gain;
+              break;
+        }
+    }
+#if 0
+    gain16=(u16)(2048-((2048*1024)/gain));
+    //gain16=(u16)(gain_double*10);
+    params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+    params->tGain_reg[1].data=gain16&0xff;//LSB
+#else
+
+    if(gain<=23040){
+        gain16=(u16)(2048-((2048*1024)/gain));
+        params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+        params->tGain_reg[1].data=gain16&0xff;//LSB
+        params->tGain_reg[2].data=0x00;
+    } else if((gain>23040)&&(gain<=46080)){
+        gain=gain>>1;
+        gain16=(u16)(2048-((2048*1024)/gain));
+        params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+        params->tGain_reg[1].data=gain16&0xff;//LSB
+        params->tGain_reg[2].data=0x01;
+    } else if((gain>46080)&&(gain<=92160)){
+        gain=gain>>2;
+        gain16=(u16)(2048-((2048*1024)/gain));
+        params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+        params->tGain_reg[1].data=gain16&0xff;//LSB
+        params->tGain_reg[2].data=0x02;
+    } else if ((gain>92160)&&(gain<=184320)){//if((gain>22.5*1024*4)&&(gain<=22.5*1024*8)){
+        gain=gain>>3;
+        gain16=(u16)(2048-((2048*1024)/gain));
+        params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+        params->tGain_reg[1].data=gain16&0xff;//LSB
+        params->tGain_reg[2].data=0x03;
+    } else if ((gain>184320)&&(gain<=368640)){//if((gain>22.5*1024*8)&&(gain<=22.5*1024*16)){
+        gain=gain>>4;
+        gain16=(u16)(2048-((2048*1024)/gain));
+        params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+        params->tGain_reg[1].data=gain16&0xff;//LSB
+        params->tGain_reg[2].data=0x04;
+    } else if ((gain>368640)&&(gain<=737280)){//if((gain>22.5*1024*16)&&(gain<=22.5*1024*32)){
+        gain=gain>>5;
+        gain16=(u16)(2048-((2048*1024)/gain));
+        params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+        params->tGain_reg[1].data=gain16&0xff;//LSB
+        params->tGain_reg[2].data=0x05;
+    } else {//if((gain>22.5*1024*32)&&(gain<=22.5*1024*64)){
+        gain=gain>>6;
+        gain16=(u16)(2048-((2048*1024)/gain));
+        params->tGain_reg[0].data=(gain16>>8)&0x07;//MSB
+        params->tGain_reg[1].data=gain16&0xff;//LSB
+        params->tGain_reg[2].data=0x06;
+    }
+    params->dirty = true;
+#endif
+
+    SENSOR_DMSG("[%s] set gain/reg0/reg1=%d/0x%x/0x%x\n", __FUNCTION__, gain, params->tGain_reg[0].data, params->tGain_reg[1].data);
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/30;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min =handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;
+    return SUCCESS;
+}
+
+static int pCus_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min =  Preview_line_period*4;
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+
+static int pCus_poweron_hdr_dol_lef(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweroff_hdr_dol_lef(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+static int pCus_GetSensorID_hdr_dol_lef(ms_cus_sensor *handle, u32 *id)
+{
+    *id = 0;
+     return SUCCESS;
+}
+static int pCus_init_hdr_dol_lef(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetVideoRes_hdr_dol_lef( ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res )
+{
+    *res = &handle->video_res_supported.res[res_idx];
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_hdr_dol_lef( ms_cus_sensor *handle, u32 res )
+{
+    handle->video_res_supported.ulcur_res = 0; //TBD
+    return SUCCESS;
+}
+#endif
+static int pCus_GetOrien_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    *orit = CUS_ORIT_M0F0;
+    return SUCCESS;
+}
+
+static int pCus_SetOrien_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_hdr_dol_lef(ms_cus_sensor *handle)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_hdr_dol_lef(ms_cus_sensor *handle, u32 fps)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*(max_fps*1000))/fps;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+          SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    pCus_SetAEUSecsHDR_DOL_LEF(handle, params->expo.expo_lef_us);
+    params->dirty = true; //reg need to update = true;
+    return SUCCESS;
+}
+static int pCus_GetShutterInfo_hdr_dol_lef(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = (Preview_line_period_HDR_DOL * 4);
+    info->step = Preview_line_period_HDR_DOL;
+    return SUCCESS;
+}
+static int pCus_GetShutterInfo_hdr_dol_sef(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    imx274_params *params = (imx274_params *)handle->private_data;
+    u32 max_rhs1 = params->vts_to_rhs1 - 2198 - Preview_CROP_START_Y_DOL;
+
+    info->max = Preview_line_period_HDR_DOL * max_rhs1;
+    info->min = (Preview_line_period_HDR_DOL * 2);
+    info->step = Preview_line_period_HDR_DOL;
+    return SUCCESS;
+}
+static int pCus_setCaliData_gain_linearity_hdr_dol_lef(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num)
+{
+    return SUCCESS;
+}
+static int pCus_SetAEGain_cal_hdr_dol_lef(ms_cus_sensor *handle, u32 gain)
+{
+    return SUCCESS;
+}
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+    u32 i, j;
+
+    for(i=0,j=0;i< num ;i++,j+=2){
+        gain_gap_compensate[i].gain=pArray[i].gain;
+        gain_gap_compensate[i].offset=pArray[i].offset;
+    }
+
+    SENSOR_DMSG("[%s]%d, %d, %d, %d\n", __FUNCTION__, num, pArray[0].gain, pArray[1].gain, pArray[num-1].offset);
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx274_params *params;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx274_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tExpo_shr_dol1_reg, expo_shr_dol1_reg, sizeof(expo_shr_dol1_reg));
+    memcpy(params->tExpo_rhs1_reg, expo_rhs1_reg, sizeof(expo_rhs1_reg));
+    memcpy(params->tExpo_shr_dol2_reg, expo_shr_dol2_reg, sizeof(expo_shr_dol2_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX274_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+	//handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth= 3864;
+    handle->video_res_supported.res[0].nOutputHeight= 2202;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "3840x2160@15fps");
+
+    handle->video_res_supported.num_res = 2;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[1].width = Preview_WIDTH;
+    handle->video_res_supported.res[1].height = Preview_HEIGHT;
+    handle->video_res_supported.res[1].max_fps= 20;
+    handle->video_res_supported.res[1].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[1].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[1].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[1].nOutputWidth= 3864;
+    handle->video_res_supported.res[1].nOutputHeight= 2202;
+    sprintf(handle->video_res_supported.res[1].strResDesc, "3840x2160@20fps");
+
+    handle->video_res_supported.num_res = 3;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[2].width = 2592;
+    handle->video_res_supported.res[2].height = 1944;
+    handle->video_res_supported.res[2].max_fps= 30;
+    handle->video_res_supported.res[2].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[2].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[2].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[2].nOutputWidth= 2592;
+    handle->video_res_supported.res[2].nOutputHeight= 1944;
+    sprintf(handle->video_res_supported.res[2].strResDesc, "2592x1944@30fps");
+
+    handle->video_res_supported.num_res = 4;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[3].width = 2944;
+    handle->video_res_supported.res[3].height = 1656;
+    handle->video_res_supported.res[3].max_fps= 30;
+    handle->video_res_supported.res[3].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[3].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[3].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[3].nOutputWidth= 2944;
+    handle->video_res_supported.res[3].nOutputHeight= 1656;
+    sprintf(handle->video_res_supported.res[3].strResDesc, "2944x1656@30fps");
+
+    handle->video_res_supported.num_res = 5;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[4].width = 2560;
+    handle->video_res_supported.res[4].height = 1440;
+    handle->video_res_supported.res[4].max_fps= 30;
+    handle->video_res_supported.res[4].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[4].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[4].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[4].nOutputWidth= 2560;
+    handle->video_res_supported.res[4].nOutputHeight= 1440;
+    sprintf(handle->video_res_supported.res[4].strResDesc, "2560x1440@30fps");
+
+    handle->video_res_supported.num_res = 6;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[5].width = 1920;
+    handle->video_res_supported.res[5].height = 1080;
+    handle->video_res_supported.res[5].max_fps= 60;
+    handle->video_res_supported.res[5].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[5].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[5].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[5].nOutputWidth= 1920;
+    handle->video_res_supported.res[5].nOutputHeight= 1080;
+    sprintf(handle->video_res_supported.res[5].strResDesc, "1920x1080@60fps");
+
+    handle->video_res_supported.num_res = 7;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[6].width = Preview_WIDTH;
+    handle->video_res_supported.res[6].height = Preview_HEIGHT;
+    handle->video_res_supported.res[6].max_fps= 30;
+    handle->video_res_supported.res[6].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[6].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[6].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[6].nOutputWidth= 3864;
+    handle->video_res_supported.res[6].nOutputHeight= 2202;
+    sprintf(handle->video_res_supported.res[6].strResDesc, "3840x2160@30fps");
+
+    // i2c
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 1;//0;//1;
+    handle->ae_shutter_delay    = 2;//1;//2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 1;
+
+    ///calibration
+    handle->sat_mingain = SENSOR_MIN_GAIN;
+
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init_mipi4lane_linear_4K15fps;
+    //handle->pCus_sensor_powerupseq  = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron     = pCus_poweron;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = imx274_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+    handle->pCus_sensor_SetAEGain_cal       = pCus_SetAEGain_cal;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+     //sensor calibration
+   // handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = pCus_GetShutterInfo;
+
+    params->dirty = false;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_sef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx274_params *params = NULL;
+
+    cus_camsensor_init_handle_linear(drv_handle);
+    params = (imx274_params *)handle->private_data;
+
+    sprintf(handle->model_id,"IMX274_MIPI_HDR_SEF");
+
+    handle->bayer_id    = SENSOR_BAYERID_HDR_DOL;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_SONY_DOL;
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[0].nOutputWidth= 0xF18;
+    handle->video_res_supported.res[0].nOutputHeight= 0x886;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "3840x2160@15fps_HDR");
+
+    handle->video_res_supported.num_res = 2;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[1].width = 1920;
+    handle->video_res_supported.res[1].height = 1080;
+    handle->video_res_supported.res[1].max_fps= 30;
+    handle->video_res_supported.res[1].min_fps= 3;
+    handle->video_res_supported.res[1].crop_start_x= 0;
+    handle->video_res_supported.res[1].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[1].nOutputWidth= 0x78C;
+    handle->video_res_supported.res[1].nOutputHeight= 0x44E;
+    sprintf(handle->video_res_supported.res[1].strResDesc, "1920x1080@30fps_HDR");
+
+    handle->video_res_supported.num_res = 3;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[2].width = Preview_WIDTH;
+    handle->video_res_supported.res[2].height = Preview_HEIGHT;
+    handle->video_res_supported.res[2].max_fps= 20;
+    handle->video_res_supported.res[2].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[2].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[2].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[2].nOutputWidth= 0xF18;
+    handle->video_res_supported.res[2].nOutputHeight= 0x886;
+    sprintf(handle->video_res_supported.res[2].strResDesc, "3840x2160@20fps_HDR");
+
+    handle->video_res_supported.num_res = 4;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[3].width = Preview_WIDTH;
+    handle->video_res_supported.res[3].height = Preview_HEIGHT;
+    handle->video_res_supported.res[3].max_fps= 30;
+    handle->video_res_supported.res[3].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[3].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[3].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[3].nOutputWidth= 0xF18;
+    handle->video_res_supported.res[3].nOutputHeight= 0x886;
+    sprintf(handle->video_res_supported.res[3].strResDesc, "3840x2160@30fps_HDR");
+
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes_HDR_DOL;
+    handle->mclk                        = Preview_MCLK_SPEED_HDR_DOL;
+
+#if (SENSOR_MIPI_LANE_NUM == 2)
+#endif
+#if (SENSOR_MIPI_LANE_NUM == 4)
+    handle->pCus_sensor_init        = pCus_init_mipi4lane_HDR_DOL_4k15fps;
+#endif
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_HDR_DOL_SEF; //TBD
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_HDR_DOL_SEF; //TBD
+
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotifyHDR_DOL_SEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_SEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+    handle->pCus_sensor_GetShutterInfo = pCus_GetShutterInfo_hdr_dol_sef;
+    params->expo.vts = vts_30fps_HDR_DOL;
+    params->expo.fps = 15;
+
+    handle->data_prec   = SENSOR_DATAPREC_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 2;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_lef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx274_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx274_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tExpo_shr_dol1_reg, expo_shr_dol1_reg, sizeof(expo_shr_dol1_reg));
+    memcpy(params->tExpo_rhs1_reg, expo_rhs1_reg, sizeof(expo_rhs1_reg));
+    memcpy(params->tExpo_shr_dol2_reg, expo_shr_dol2_reg, sizeof(expo_shr_dol2_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX274_MIPI_HDR_LEF");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC_HDR_DOL;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID_HDR_DOL;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_SONY_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num =  0; //Long frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[0].nOutputWidth= 0xF18;
+    handle->video_res_supported.res[0].nOutputHeight= 0x886;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "3840x2160@15fps_HDR");
+
+    handle->video_res_supported.num_res = 2;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[1].width = 1920;
+    handle->video_res_supported.res[1].height = 1080;
+    handle->video_res_supported.res[1].max_fps= 30;
+    handle->video_res_supported.res[1].min_fps= 3;
+    handle->video_res_supported.res[1].crop_start_x= 0;
+    handle->video_res_supported.res[1].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[1].nOutputWidth= 0x78C;
+    handle->video_res_supported.res[1].nOutputHeight= 0x44E;
+    sprintf(handle->video_res_supported.res[1].strResDesc, "1920x1080@30fps_HDR");
+
+    handle->video_res_supported.num_res = 3;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[2].width = Preview_WIDTH;
+    handle->video_res_supported.res[2].height = Preview_HEIGHT;
+    handle->video_res_supported.res[2].max_fps= 20;
+    handle->video_res_supported.res[2].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[2].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[2].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[2].nOutputWidth= 0xF18;
+    handle->video_res_supported.res[2].nOutputHeight= 0x886;
+    sprintf(handle->video_res_supported.res[2].strResDesc, "3840x2160@20fps_HDR");
+
+    handle->video_res_supported.num_res = 4;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[3].width = Preview_WIDTH;
+    handle->video_res_supported.res[3].height = Preview_HEIGHT;
+    handle->video_res_supported.res[3].max_fps= 30;
+    handle->video_res_supported.res[3].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[3].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[3].crop_start_y= Preview_CROP_START_Y_DOL;
+    handle->video_res_supported.res[3].nOutputWidth= 0xF18;
+    handle->video_res_supported.res[3].nOutputHeight= 0x886;
+    sprintf(handle->video_res_supported.res[3].strResDesc, "3840x2160@30fps_HDR");
+
+    // i2c
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED_HDR_DOL;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 1;//0;//1;
+    handle->ae_shutter_delay    = 2;//1;//2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 2;
+
+    ///calibration
+    handle->sat_mingain = SENSOR_MIN_GAIN;
+
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init_hdr_dol_lef;
+    //handle->pCus_sensor_powerupseq  = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron     = pCus_poweron_hdr_dol_lef;
+    handle->pCus_sensor_poweroff    = pCus_poweroff_hdr_dol_lef;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID_hdr_dol_lef;
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes_HDR_DOL;
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien_hdr_dol_lef;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien_hdr_dol_lef;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_hdr_dol_lef;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_hdr_dol_lef;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap_hdr_dol_lef;
+    //handle->pCus_sensor_SetPatternMode = pCus_SetPatternMode_hdr_dol_lef;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotifyHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs_hdr_dol_lef;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain_hdr_dol_lef;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain_hdr_dol_lef;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    //handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_hdr_dol_lef;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal_hdr_dol_lef;
+    handle->pCus_sensor_setCaliData_gain_linearity= pCus_setCaliData_gain_linearity_hdr_dol_lef;
+    handle->pCus_sensor_GetShutterInfo = pCus_GetShutterInfo_hdr_dol_lef;
+#if 0//defined(__MV5_FPGA__)
+    handle->pCus_sensor_I2CWrite = pCus_I2CWrite_hdr_dol_lef; //Andy Liu
+    handle->pCus_sensor_I2CRead = pCus_I2CRead_hdr_dol_lef; //Andy Liu
+#endif
+    params->expo.vts = vts_30fps_HDR_DOL;
+    params->expo.fps = 15;
+    params->dirty = false;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(  IMX274_HDR,
+                            cus_camsensor_init_handle_linear,
+                            cus_camsensor_init_handle_hdr_dol_sef,
+                            cus_camsensor_init_handle_hdr_dol_lef,
+                            imx274_params
+                         );
+
+
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx335_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx335_mipi.c
new file mode 100644
index 00000000..5e5b5847
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx335_mipi.c
@@ -0,0 +1,3458 @@
+/* SigmaStar trade secret */
+/* Copyright (c) [2019~2020] SigmaStar Technology.
+All rights reserved.
+
+Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+SigmaStar and be kept in strict confidence
+(SigmaStar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of SigmaStar Confidential
+Information is unlawful and strictly prohibited. SigmaStar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(IMX335_HDR);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+//#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+//#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE            CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL   CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+#define ENABLE            1
+#define DISABLE           0
+#undef SENSOR_DBG
+#define SENSOR_DBG        0
+
+#define DEBUG_INFO        0
+
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+//#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+///////////////////////////////////////////////////////////////
+//          @@@                                              //
+//         @ @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//          @@@@                                             //
+//                                                           //
+//      Start Step 1 --  show preview on LCM                 //
+//                                                           //
+//  Fill these #define value and table with correct settings //
+//      camera can work and show preview on LCM              //
+//                                                           //
+///////////////////////////////////////////////////////////////
+
+////////////////////////////////////
+// Sensor-If Info                 //
+////////////////////////////////////
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM        (lane_num)          //IMX335 Linear mode supports MIPI 2/4 Lane
+#define SENSOR_MIPI_LANE_NUM_DOL    (4) //(hdr_lane_num)//IMX335 DOL mode supports MIPI 4 Lane
+//#define SENSOR_MIPI_HDR_MODE        (0) //0: Non-HDR mode. 1:Sony DOL mode
+
+#define SENSOR_ISP_TYPE             ISP_EXT             //ISP_EXT, ISP_SOC (Non-used)
+#define SENSOR_IFBUS_TYPE           CUS_SENIF_BUS_MIPI  //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE      PACKET_HEADER_EDGE1
+#define SENSOR_MIPI_HSYNC_MODE_HDR_DOL PACKET_FOOTER_EDGE
+#define SENSOR_DATAPREC             CUS_DATAPRECISION_10
+#define SENSOR_DATAPREC_DOL         CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE             CUS_SEN_10TO12_9098  //CFG
+#define SENSOR_BAYERID              CUS_BAYER_RG         //0h: CUS_BAYER_RG, 1h: CUS_BAYER_GR, 2h: CUS_BAYER_BG, 3h: CUS_BAYER_GB
+#define SENSOR_BAYERID_HDR_DOL      CUS_BAYER_RG
+#define SENSOR_RGBIRID              CUS_RGBIR_NONE
+#define SENSOR_ORIT                 CUS_ORIT_M0F0        //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+
+////////////////////////////////////
+// MCLK Info                      //
+////////////////////////////////////
+#define Preview_MCLK_SPEED          CUS_CMU_CLK_27MHZ    //CUS_CMU_CLK_24MHZ //CUS_CMU_CLK_37P125MHZ//CUS_CMU_CLK_27MHZ
+#define Preview_MCLK_SPEED_HDR_DOL  CUS_CMU_CLK_27MHZ
+
+////////////////////////////////////
+// I2C Info                       //
+////////////////////////////////////
+#define SENSOR_I2C_ADDR              0x34                //I2C slave address
+#define SENSOR_I2C_SPEED             300000              //200000 //300000 //240000                  //I2C speed, 60000~320000
+#define SENSOR_I2C_LEGACY            I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT               I2C_FMT_A16D8       //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+////////////////////////////////////
+// Sensor Signal                  //
+////////////////////////////////////
+#define SENSOR_PWDN_POL              CUS_CLK_POL_NEG     // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL               CUS_CLK_POL_NEG     // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+                                                         // VSYNC/HSYNC POL can be found in data sheet timing diagram,
+                                                         // Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+#define SENSOR_VSYNC_POL             CUS_CLK_POL_NEG     // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL             CUS_CLK_POL_NEG     // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL              CUS_CLK_POL_NEG     // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+////////////////////////////////////
+// Sensor ID                      //
+////////////////////////////////////
+//define SENSOR_ID
+
+#undef SENSOR_NAME
+#define SENSOR_NAME     IMX335
+
+////////////////////////////////////
+// Image Info                     //
+////////////////////////////////////
+static struct {     // LINEAR
+    // Modify it based on number of support resolution
+    enum {LINEAR_RES_1 = 0, LINEAR_RES_2, LINEAR_RES_END}mode;
+    // Sensor Output Image info
+    struct _senout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _sensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _senstr{
+        const char* strResDesc;
+    }senstr;
+}imx335_mipi_linear[] = {
+    {LINEAR_RES_1, {2592, 1944, 3, 25}, {0, 0, 2592, 1944}, {"2592x1944@25fps"}},
+    {LINEAR_RES_2, {2592, 1944, 3, 30}, {0, 0, 2592, 1944}, {"2592x1944@30fps"}}, // Modify it
+};
+
+static struct {     // HDR
+    // Modify it based on number of support resolution
+    enum {HDR_RES_1 = 0, HDR_RES_2, HDR_RES_3, HDR_RES_END}mode;
+    // Sensor Output Image info
+    struct _hsenout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _hsensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _hsenstr{
+        const char* strResDesc;
+    }senstr;
+}imx335_mipi_hdr[] = {
+    {HDR_RES_1, {2592, 1944, 3, 25}, {4, 0, 2592, 1944}, {"2592x1944@25fps_HDR"}}, // Modify it
+    {HDR_RES_2, {2592, 1944, 3, 20}, {4, 0, 2592, 1944}, {"2592x1944@20fps_HDR"}}, // Modify it
+    {HDR_RES_3, {2592, 1944, 3, 30}, {4, 0, 2592, 1944}, {"2592x1944@30fps_HDR"}}, // Modify it
+};
+
+#define IMX335_HDR_BRL                              2228
+
+u32 Preview_line_period;
+u32 vts_30fps;
+u32 Preview_MAX_FPS;
+u32 Preview_line_period_HDR_DOL;
+u32 vts_30fps_HDR_DOL;
+
+////////////////////////////////////
+// AE Info                        //
+////////////////////////////////////
+#define SENSOR_MAX_GAIN                             (1412 * 1024)        // max sensor again, a-gain * conversion-gain*d-gain
+#define SENSOR_MIN_GAIN                             (1 * 1024)
+#define SENSOR_GAIN_DELAY_FRAME_COUNT               (2)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT            (2)
+#define SENSOR_GAIN_DELAY_FRAME_COUNT_HDR_DOL       (1)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL    (2)
+
+////////////////////////////////////
+// Mirror-Flip Info               //
+////////////////////////////////////
+#define REG_MIRROR                                  0x304E
+#define REG_FLIP                                    0x304F
+#define SENSOR_NOR                                  0x0
+#define MIRROR_EN                                   0x1 << (0)
+#define FLIP_EN                                     0x1 << (0)
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+
+//static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+static int pCus_SetAEUSecsHDR_DOL_SEF1(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us);
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 expo_lines;
+        u32 expo_lef_us;
+        u32 expo_sef_us;
+    } expo;
+    u32 max_rhs1;
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool dirty;
+    bool orien_dirty;
+    I2C_ARRAY tVts_reg[3];
+    I2C_ARRAY tGain_reg[2];
+    I2C_ARRAY tExpo_reg[3];
+    I2C_ARRAY tExpo_shr_dol1_reg[3];
+    I2C_ARRAY tExpo_rhs1_reg[3];
+    I2C_ARRAY tGain_hdr_dol_lef_reg[2];
+    I2C_ARRAY tGain_hdr_dol_sef_reg[2];
+} imx335_params;
+
+// set sensor ID address and data,
+const static I2C_ARRAY Sensor_id_table[] =
+{
+    {0x3003, 0x00},      // {address of ID, ID },
+    {0x3033, 0x00}
+};
+
+const static I2C_ARRAY Sensor_init_table_2lane_5m25fps[] =
+{
+    /*"IMX335LQN All-pixel scan CSI-2_2lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 25fps"*/
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},  //BCWAIT_TIME
+    {0x300D,0x2E},  //CPWAIT_TIME
+    {0x3030,0x56},  //VMAX //101Dh: 4125 //1518h: 5400
+    {0x3031,0x13},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+    {0x3050,0x00},  //ADBIT
+
+    {0x305a,0x00},  // bit0-3(16-18)
+    {0x3059,0x0E},  // bit0-7(8-15)
+    {0x3058,0x80},  // bit0-7
+
+    {0x314C,0xB0},  //INCKSEL1
+    {0x315A,0x02},  //INCKSEL2
+    {0x3168,0x8F},  //INCKSEL3
+    {0x316A,0x7E},  //INCKSEL4
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},  //XH&VSOUTSEL
+    {0x31A1,0x00},  //XVS/XHS pin setting
+    {0x31A4,0x00},  //PULSE1_UP
+    {0x31A5,0x00},  //PULSE1_UP
+    {0x31A6,0x00},  //PULSE1_UP
+    {0x31A8,0x00},  //PULSE1EN/PULSE1_POL
+    {0x31AC,0x00},  //PULSE1_DN
+    {0x31AD,0x00},  //PULSE1_DN
+    {0x31AE,0x00},  //PULSE1_DN
+    {0x31D4,0x00},  //XVSLNG
+    {0x31D5,0x00},  //XHSLNG
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x341D,0x01},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3A01,0x01},  //LANEMODE 0x03:4Lane  0x01:2Lane
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_2lane_5m30fps[] =
+{
+    /*"IMX335LQN All-pixel scan CSI-2_2lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 30fps"*/
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},  //BCWAIT_TIME
+    {0x300D,0x2E},  //CPWAIT_TIME
+    {0x3030,0x1D},  //VMAX //1194 :4500 //101D: 4125
+    {0x3031,0x10},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+    {0x3050,0x00},  //ADBIT
+
+    {0x305a,0x00},  // bit0-3(16-18)
+    {0x3059,0x0E},  // bit0-7(8-15)
+    {0x3058,0x80},  // bit0-7
+
+    {0x314C,0xB0},  //INCKSEL1
+    {0x315A,0x02},  //INCKSEL2
+    {0x3168,0x8F},  //INCKSEL3
+    {0x316A,0x7E},  //INCKSEL4
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},  //XH&VSOUTSEL
+    {0x31A1,0x00},  //XVS/XHS pin setting
+    {0x31A4,0x00},  //PULSE1_UP
+    {0x31A5,0x00},  //PULSE1_UP
+    {0x31A6,0x00},  //PULSE1_UP
+    {0x31A8,0x00},  //PULSE1EN/PULSE1_POL
+    {0x31AC,0x00},  //PULSE1_DN
+    {0x31AD,0x00},  //PULSE1_DN
+    {0x31AE,0x00},  //PULSE1_DN
+    {0x31D4,0x00},  //XVSLNG
+    {0x31D5,0x00},  //XHSLNG
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x341D,0x01},  //ADBIT1 10Bit:0x01FF  12Bit:0x0047
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3A01,0x01},  //LANEMODE 0x03:4Lane  0x01:2Lane
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_4lane_5m25fps[] =
+{
+/* "IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 25fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x56},  //VMAX //101Dh: 4125 //1518h: 5400
+    {0x3031,0x13},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+
+    {0x305a,0x00},  // bit0-3(16-18)
+    {0x3059,0x0E},  // bit0-7(8-15)
+    {0x3058,0x80},  // bit0-7
+
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xFF},  //0x47--12-bit   0xff--10bit
+    {0x341d,0x01},  //0x00--12-bit   0x01--10bit
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_4lane_5m30fps[] =
+{
+/* "IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode 30fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x1D},  //VMAX //1194 :4500 //101D: 4125
+    {0x3031,0x10},  //VMAX
+    {0x3032,0x00},  //VMAX
+    {0x3034,0x58},  //HMAX //2D0h: 720  //226h: 550
+    {0x3035,0x02},  //HMAX
+
+    {0x305a,0x00},  // bit0-3(16-18)
+    {0x3059,0x0E},  // bit0-7(8-15)
+    {0x3058,0x80},  // bit0-7
+
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},  //MDBIT 0:10Bit  1:12Bit
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x00},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xFF},  //0x47--12-bit   0xff--10bit
+    {0x341d,0x01},  //0x00--12-bit   0x01--10bit
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375D,0x00},
+    {0x375E,0x00},
+    {0x375F,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3000,0x00},
+    {0x3002,0x00},
+};
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_4lane5m25fps[] =
+{
+#if 1
+/*"IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode DOL HDR 2frameLI 25fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x9A}, //VMAX 1518: 5400 //4500 1194 //4250 109A
+    {0x3031,0x10},
+    {0x3032,0x00},
+    {0x3034,0x5D}, //HMAX 113: 275  14A          //15Dh 349
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304A,0x04},
+    {0x304B,0x03},
+    {0x304C,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07}, //Y_OUT_SIZE[7:0]
+    {0x3057,0x08}, //Y_OUT_SIZE[12:8]
+    {0x3058,0x88},
+    {0x3059,0x1D},
+    {0x305A,0x00},
+    {0x305C,0x12},
+    {0x305D,0x00},
+    {0x305E,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306A,0x00},
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},
+    {0x319F,0x00}, //0x2
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x01},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3300,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},//0x47--12-bit   0xff--10bit
+    {0x341D,0x01},//
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3000,0x00},
+    {0x3002,0x00},
+#else //Ori_24Mhz
+    {0x3000,0x01},
+    {0x3001,0x00},
+    {0x3002,0x01},
+    {0x3003,0x00},
+
+    {0x300c,0x3b},
+    {0x300d,0x2a},
+    {0x3018,0x00},
+    {0x302c,0x30},
+    {0x302d,0x00},
+    {0x302e,0x38},
+    {0x302f,0x0a},
+
+    {0x3030,0x9A}, //VMAX 1518: 5400 //4500 1194 //4250 109A
+    {0x3031,0x10},
+    {0x3032,0x00},
+    {0x3034,0x5D}, //HMAX 113: 275  14A          //15Dh 349
+    {0x3035,0x01},
+
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304a,0x04},
+    {0x304b,0x03},
+    {0x304c,0x00},
+    {0x304e,0x00},
+    {0x304f,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07},
+    {0x3057,0x08},
+    {0x3058,0x88},
+    {0x3059,0x1d},
+    {0x305a,0x00},
+    {0x305c,0x12},
+    {0x305d,0x00},
+    {0x305e,0x00},
+    {0x3060,0xe8},
+    {0x3061,0x00},
+    {0x3062,0x00},
+    {0x3064,0x09},
+    {0x3065,0x00},
+    {0x3066,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306a,0x00},
+    {0x306c,0x68},
+    {0x306d,0x06},
+    {0x306e,0x00},
+    {0x3072,0x28},
+    {0x3073,0x00},
+    {0x3074,0xb0},
+    {0x3075,0x00},
+    {0x3076,0x58},
+    {0x3077,0x0f},
+
+    {0x3078,0x01},
+    {0x3079,0x02},
+    {0x307a,0xff},
+    {0x307b,0x02},
+    {0x307c,0x00},
+    {0x307d,0x00},
+    {0x307e,0x00},
+    {0x307f,0x00},
+    {0x3080,0x01},
+    {0x3081,0x02},
+    {0x3082,0xff},
+    {0x3083,0x02},
+    {0x3084,0x00},
+    {0x3085,0x00},
+    {0x3086,0x00},
+    {0x3087,0x00},
+
+    {0x30a4,0x33},
+    {0x30a8,0x10},
+    {0x30a9,0x04},
+    {0x30ac,0x00},
+    {0x30ad,0x00},
+    {0x30b0,0x10},
+    {0x30b1,0x08},
+    {0x30b4,0x00},
+    {0x30b5,0x00},
+    {0x30b6,0x00},
+    {0x30b7,0x00},
+
+    {0x30c6,0x00},
+    {0x30c7,0x00},
+    {0x30ce,0x00},
+    {0x30cf,0x00},
+    {0x30d8,0x4c},
+    {0x30d9,0x10},
+    {0x30e8,0x00},
+    {0x30e9,0x00},
+    {0x30ea,0x00},
+    {0x30eb,0x00},
+    {0x30ec,0x00},
+    {0x30ed,0x00},
+    {0x30ee,0x00},
+    {0x30ef,0x00},
+    {0x3112,0x08},
+    {0x3113,0x00},
+    {0x3116,0x08},
+    {0x3117,0x00},
+    {0x314c,0xc6},
+    {0x314d,0x00},
+    {0x315a,0x02},
+    {0x3167,0x01},
+    {0x3168,0xa0},
+    {0x316a,0x7e},
+    {0x3199,0x00},
+    {0x319d,0x00},
+    {0x319e,0x01},
+    {0x319f,0x00},
+    {0x31a0,0x2a},
+    {0x31a1,0x00},
+    {0x31a4,0x00},
+    {0x31a5,0x00},
+    {0x31a6,0x00},
+    {0x31a8,0x00},
+    {0x31ac,0x00},
+    {0x31ad,0x00},
+    {0x31ae,0x00},
+    {0x31d4,0x00},
+    {0x31d5,0x00},
+    {0x31d7,0x01},
+    {0x31e4,0x01},
+    {0x31e8,0x00},
+    {0x31f3,0x01},
+    {0x3200,0x01},
+    {0x3288,0x21},
+    {0x328a,0x02},
+    {0x3300,0x00},
+    {0x3302,0x32},
+    {0x3303,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xff},//0x47--12-bit   0xff--10bit
+    {0x341d,0x01},//
+    {0x3648,0x01},
+    {0x364a,0x04},
+    {0x364c,0x04},
+    {0x3678,0x01},
+    {0x367c,0x31},
+    {0x367e,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371c,0x3d},
+    {0x371d,0x3f},
+    {0x372c,0x00},
+    {0x372d,0x00},
+    {0x372e,0x46},
+    {0x372f,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xfe},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1b},
+    {0x3769,0x1b},
+    {0x376a,0x1b},
+    {0x376b,0x1b},
+    {0x376c,0x1a},
+    {0x376d,0x17},
+    {0x376e,0x0f},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377a,0x89},
+    {0x377b,0x00},
+    {0x377c,0x08},
+    {0x377d,0x01},
+    {0x377e,0x23},
+    {0x377f,0x02},
+    {0x3780,0xd9},
+    {0x3781,0x03},
+    {0x3782,0xf5},
+    {0x3783,0x06},
+    {0x3784,0xa5},
+    {0x3788,0x0f},
+    {0x378a,0xd9},
+    {0x378b,0x03},
+    {0x378c,0xeb},
+    {0x378d,0x05},
+    {0x378e,0x87},
+    {0x378f,0x06},
+    {0x3790,0xf5},
+    {0x3792,0x43},
+    {0x3794,0x7a},
+    {0x3796,0xa1},
+    {0x37b0,0x36},
+    {0x3a01,0x03},
+    {0x3a04,0x90},
+    {0x3a05,0x12},
+    {0x3a18,0x8f},
+    {0x3a19,0x00},
+    {0x3a1a,0x4f},
+    {0x3a1b,0x00},
+    {0x3a1c,0x47},
+    {0x3a1d,0x00},
+    {0x3a1e,0x37},
+    {0x3a1f,0x01},
+    {0x3a20,0x4f},
+    {0x3a21,0x00},
+    {0x3a22,0x87},
+    {0x3a23,0x00},
+    {0x3a24,0x4f},
+    {0x3a25,0x00},
+    {0x3a26,0x7f},
+    {0x3a27,0x00},
+    {0x3a28,0x3f},
+    {0x3a29,0x00},
+
+    {0x3000,0x00},
+    {0x3002,0x00},
+#endif
+};
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_4lane5m20fps[] =
+{
+#if 1
+/*"IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode DOL HDR 2frameLI 25fps" */
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0xC0}, //VMAX 1518: 5400 //4500 1194 //4250 109A
+    {0x3031,0x14},
+    {0x3032,0x00},
+    {0x3034,0x5D}, //HMAX 113: 275  14A          //15Dh 349
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304A,0x04},
+    {0x304B,0x03},
+    {0x304C,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07}, //Y_OUT_SIZE[7:0]
+    {0x3057,0x08}, //Y_OUT_SIZE[12:8]
+    {0x3058,0x88},
+    {0x3059,0x1D},
+    {0x305A,0x00},
+    {0x305C,0x12},
+    {0x305D,0x00},
+    {0x305E,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306A,0x00},
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},
+    {0x319F,0x00}, //0x2
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x01},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3300,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},//0x47--12-bit   0xff--10bit
+    {0x341D,0x01},//
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3000,0x00},
+    {0x3002,0x00},
+#else //Ori_24Mhz
+    {0x3000,0x01},
+    {0x3001,0x00},
+    {0x3002,0x01},
+    {0x3003,0x00},
+    {0x300c,0x3b},
+    {0x300d,0x2a},
+    {0x3018,0x00},
+    {0x302c,0x30},
+    {0x302d,0x00},
+    {0x302e,0x38},
+    {0x302f,0x0a},
+    {0x3030,0xc0},  //14c0:5312 1A5Eh : 6750  // 16A8h : 5800
+    {0x3031,0x14},
+    {0x3032,0x00},
+    {0x3033,0x00},
+    {0x3034,0x5d},  //15d:349 113h : 275   // 140h : 320
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304a,0x04},
+    {0x304b,0x03},
+    {0x304c,0x00},
+    {0x304e,0x00},
+    {0x304f,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07},
+    {0x3057,0x08},
+    {0x3058,0x14},
+    {0x3059,0x28},
+    {0x305a,0x00},
+    {0x305c,0x12},
+    {0x305d,0x00},
+    {0x305e,0x00},
+    {0x3060,0xe8},
+    {0x3061,0x00},
+    {0x3062,0x00},
+    {0x3064,0x09},
+    {0x3065,0x00},
+    {0x3066,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306a,0x00},
+    {0x306c,0x68},
+    {0x306d,0x06},
+    {0x306e,0x00},
+    {0x3072,0x28},
+    {0x3073,0x00},
+    {0x3074,0xb0},
+    {0x3075,0x00},
+    {0x3076,0x58},
+    {0x3077,0x0f},
+    {0x3078,0x01},
+    {0x3079,0x02},
+    {0x307a,0xff},
+    {0x307b,0x02},
+    {0x307c,0x00},
+    {0x307d,0x00},
+    {0x307e,0x00},
+    {0x307f,0x00},
+    {0x3080,0x01},
+    {0x3081,0x02},
+    {0x3082,0xff},
+    {0x3083,0x02},
+    {0x3084,0x00},
+    {0x3085,0x00},
+    {0x3086,0x00},
+    {0x3087,0x00},
+    {0x30a4,0x33},
+    {0x30a8,0x10},
+    {0x30a9,0x04},
+    {0x30ac,0x00},
+    {0x30ad,0x00},
+    {0x30b0,0x10},
+    {0x30b1,0x08},
+    {0x30b4,0x00},
+    {0x30b5,0x00},
+    {0x30b6,0x00},
+    {0x30b7,0x00},
+
+    {0x30c6,0x00},
+    {0x30c7,0x00},
+    {0x30ce,0x00},
+    {0x30cf,0x00},
+    {0x30d8,0x4c},
+    {0x30d9,0x10},
+    {0x30e8,0x00},
+    {0x30e9,0x00},
+    {0x30ea,0x00},
+    {0x30eb,0x00},
+    {0x30ec,0x00},
+    {0x30ed,0x00},
+    {0x30ee,0x00},
+    {0x30ef,0x00},
+    {0x3112,0x08},
+    {0x3113,0x00},
+    {0x3116,0x08},
+    {0x3117,0x00},
+    {0x314c,0xc6},
+    {0x314d,0x00},
+    {0x315a,0x02},
+    {0x3167,0x01},
+    {0x3168,0xa0},
+    {0x316a,0x7e},
+    {0x3199,0x00},
+    {0x319d,0x00},
+    {0x319e,0x01},
+    {0x319f,0x00},
+    {0x31a0,0x2a},
+    {0x31a1,0x00},
+    {0x31a4,0x00},
+    {0x31a5,0x00},
+    {0x31a6,0x00},
+    {0x31a8,0x00},
+    {0x31ac,0x00},
+    {0x31ad,0x00},
+    {0x31ae,0x00},
+    {0x31d4,0x00},
+    {0x31d5,0x00},
+    {0x31d7,0x01},
+    {0x31e4,0x01},
+    {0x31e8,0x00},
+    {0x31f3,0x01},
+    {0x3200,0x01},
+    {0x3288,0x21},
+    {0x328a,0x02},
+    {0x3300,0x00},
+    {0x3302,0x32},
+    {0x3303,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xff},//0x47--12-bit   0xff--10bit
+    {0x341d,0x01},//
+    {0x3648,0x01},
+    {0x364a,0x04},
+    {0x364c,0x04},
+    {0x3678,0x01},
+    {0x367c,0x31},
+    {0x367e,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371c,0x3d},
+    {0x371d,0x3f},
+    {0x372c,0x00},
+    {0x372d,0x00},
+    {0x372e,0x46},
+    {0x372f,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xfe},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1b},
+    {0x3769,0x1b},
+    {0x376a,0x1b},
+    {0x376b,0x1b},
+    {0x376c,0x1a},
+    {0x376d,0x17},
+    {0x376e,0x0f},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377a,0x89},
+    {0x377b,0x00},
+    {0x377c,0x08},
+    {0x377d,0x01},
+    {0x377e,0x23},
+    {0x377f,0x02},
+    {0x3780,0xd9},
+    {0x3781,0x03},
+    {0x3782,0xf5},
+    {0x3783,0x06},
+    {0x3784,0xa5},
+    {0x3788,0x0f},
+    {0x378a,0xd9},
+    {0x378b,0x03},
+    {0x378c,0xeb},
+    {0x378d,0x05},
+    {0x378e,0x87},
+    {0x378f,0x06},
+    {0x3790,0xf5},
+    {0x3792,0x43},
+    {0x3794,0x7a},
+    {0x3796,0xa1},
+    {0x37b0,0x36},
+    {0x3a01,0x03},
+    {0x3a04,0x90},
+    {0x3a05,0x12},
+    {0x3a18,0x8f},
+    {0x3a19,0x00},
+    {0x3a1a,0x4f},
+    {0x3a1b,0x00},
+    {0x3a1c,0x47},
+    {0x3a1d,0x00},
+    {0x3a1e,0x37},
+    {0x3a1f,0x01},
+    {0x3a20,0x4f},
+    {0x3a21,0x00},
+    {0x3a22,0x87},
+    {0x3a23,0x00},
+    {0x3a24,0x4f},
+    {0x3a25,0x00},
+    {0x3a26,0x7f},
+    {0x3a27,0x00},
+    {0x3a28,0x3f},
+    {0x3a29,0x00},
+
+    {0x3000,0x00},
+    {0x3002,0x00},
+#endif
+};
+
+const static I2C_ARRAY Sensor_init_table_HDR_DOL_4lane5m30fps[] =
+{
+/*"IMX335LQN All-pixel scan CSI-2_4lane 1188Mbps AD:10bit Output:10bit 27MHz Master Mode DOL HDR 2frameLI 30fps"*/
+#if 1
+    {0x3002,0x01},  //Master mode stop
+    {0xffff,0x14},  //delay
+    {0x3000,0x01},  //standby
+    {0xffff,0x14},  //delay
+    {0x300C,0x42},
+    {0x300D,0x2E},
+    {0x3030,0x9a},  //4250 109a//4096 1000h
+    {0x3031,0x10},
+    {0x3032,0x00},
+    {0x3034,0x21},  //HMAX 121: 121h 300 : 12Ch
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304A,0x04},
+    {0x304B,0x03},
+    {0x304C,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07}, //Y_OUT_SIZE[7:0]
+    {0x3057,0x08}, //Y_OUT_SIZE[12:8]
+    {0x3058,0x1C},
+    {0x3059,0x22},
+    {0x305A,0x00},
+    {0x305C,0x12},
+    {0x305D,0x00},
+    {0x305E,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306A,0x00},
+    {0x314C,0xB0},
+    {0x315A,0x02},
+    {0x3168,0x8F},
+    {0x316A,0x7E},
+    {0x319D,0x00},
+    {0x319F,0x00}, //0x2
+    {0x31A0,0x2A},
+    {0x31A1,0x00},
+    {0x31A4,0x00},
+    {0x31A5,0x00},
+    {0x31A6,0x00},
+    {0x31A8,0x00},
+    {0x31AC,0x00},
+    {0x31AD,0x00},
+    {0x31AE,0x00},
+    {0x31D4,0x00},
+    {0x31D5,0x00},
+    {0x31D7,0x01},
+    {0x31E4,0x01},
+    {0x31F3,0x01},
+    {0x3288,0x21},
+    {0x328A,0x02},
+    {0x3300,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341C,0xFF},//0x47--12-bit   0xff--10bit
+    {0x341D,0x01},//
+    {0x3648,0x01},
+    {0x364A,0x04},
+    {0x364C,0x04},
+    {0x3678,0x01},
+    {0x367C,0x31},
+    {0x367E,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371C,0x3D},
+    {0x371D,0x3F},
+    {0x372C,0x00},
+    {0x372D,0x00},
+    {0x372E,0x46},
+    {0x372F,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xFE},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1B},
+    {0x3769,0x1B},
+    {0x376A,0x1B},
+    {0x376B,0x1B},
+    {0x376C,0x1A},
+    {0x376D,0x17},
+    {0x376E,0x0F},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377A,0x89},
+    {0x377B,0x00},
+    {0x377C,0x08},
+    {0x377D,0x01},
+    {0x377E,0x23},
+    {0x377F,0x02},
+    {0x3780,0xD9},
+    {0x3781,0x03},
+    {0x3782,0xF5},
+    {0x3783,0x06},
+    {0x3784,0xA5},
+    {0x3788,0x0F},
+    {0x378A,0xD9},
+    {0x378B,0x03},
+    {0x378C,0xEB},
+    {0x378D,0x05},
+    {0x378E,0x87},
+    {0x378F,0x06},
+    {0x3790,0xF5},
+    {0x3792,0x43},
+    {0x3794,0x7A},
+    {0x3796,0xA1},
+    {0x3000,0x00},
+    {0x3002,0x00},
+#else
+    {0x3000,0x01},
+    {0x3001,0x00},
+    {0x3002,0x01},
+    {0x3003,0x00},
+
+    {0x300c,0x3b},
+    {0x300d,0x2a},
+    {0x3018,0x00},
+    {0x302c,0x30},
+    {0x302d,0x00},
+    {0x302e,0x38},
+    {0x302f,0x0a},
+
+    {0x3030,0x9a}, //VMAX 119a:4506, 109ah:4250
+    {0x3031,0x10},
+    {0x3032,0x00},
+    {0x3033,0x00},
+    {0x3034,0x23}, //HMAX 113h:275, 123:291
+    {0x3035,0x01},
+    {0x3048,0x01},
+    {0x3049,0x01},
+    {0x304a,0x04},
+    {0x304b,0x03},
+    {0x304c,0x00},
+    {0x304e,0x00},
+    {0x304f,0x00},
+    {0x3050,0x00},
+    {0x3056,0x07},
+    {0x3057,0x08},
+    {0x3058,0x9c},
+    {0x3059,0x18},
+    {0x305a,0x00},
+    {0x305c,0x12},
+    {0x305d,0x00},
+    {0x305e,0x00},
+    {0x3060,0xe8},
+    {0x3061,0x00},
+    {0x3062,0x00},
+    {0x3064,0x09},
+    {0x3065,0x00},
+    {0x3066,0x00},
+    {0x3068,0x22},
+    {0x3069,0x01},
+    {0x306a,0x00},
+    {0x306c,0x68},
+    {0x306d,0x06},
+    {0x306e,0x00},
+    {0x3072,0x28},
+    {0x3073,0x00},
+    {0x3074,0xb0},
+    {0x3075,0x00},
+    {0x3076,0x58},
+    {0x3077,0x0f},
+
+    {0x3078,0x01},
+    {0x3079,0x02},
+    {0x307a,0xff},
+    {0x307b,0x02},
+    {0x307c,0x00},
+    {0x307d,0x00},
+    {0x307e,0x00},
+    {0x307f,0x00},
+    {0x3080,0x01},
+    {0x3081,0x02},
+    {0x3082,0xff},
+    {0x3083,0x02},
+    {0x3084,0x00},
+    {0x3085,0x00},
+    {0x3086,0x00},
+    {0x3087,0x00},
+
+    {0x30a4,0x33},
+    {0x30a8,0x10},
+    {0x30a9,0x04},
+    {0x30ac,0x00},
+    {0x30ad,0x00},
+    {0x30b0,0x10},
+    {0x30b1,0x08},
+    {0x30b4,0x00},
+    {0x30b5,0x00},
+    {0x30b6,0x00},
+    {0x30b7,0x00},
+
+    {0x30c6,0x00},
+    {0x30c7,0x00},
+    {0x30ce,0x00},
+    {0x30cf,0x00},
+    {0x30d8,0x4c},
+    {0x30d9,0x10},
+    {0x30e8,0x00},
+    {0x30e9,0x00},
+    {0x30ea,0x00},
+    {0x30eb,0x00},
+    {0x30ec,0x00},
+    {0x30ed,0x00},
+    {0x30ee,0x00},
+    {0x30ef,0x00},
+    {0x3112,0x08},
+    {0x3113,0x00},
+    {0x3116,0x08},
+    {0x3117,0x00},
+    {0x314c,0xc6},
+    {0x314d,0x00},
+    {0x315a,0x02},
+    {0x3167,0x01},
+    {0x3168,0xa0},
+    {0x316a,0x7e},
+    {0x3199,0x00},
+    {0x319d,0x00},
+    {0x319e,0x01},
+    {0x319f,0x02},
+    {0x31a0,0x2a},
+    {0x31a1,0x00},
+    {0x31a4,0x00},
+    {0x31a5,0x00},
+    {0x31a6,0x00},
+    {0x31a8,0x00},
+    {0x31ac,0x00},
+    {0x31ad,0x00},
+    {0x31ae,0x00},
+    {0x31d4,0x00},
+    {0x31d5,0x00},
+    {0x31d7,0x01},
+    {0x31e4,0x01},
+    {0x31e8,0x00},
+    {0x31f3,0x01},
+    {0x3200,0x01},
+    {0x3288,0x21},
+    {0x328a,0x02},
+    {0x3300,0x00},
+    {0x3302,0x32},
+    {0x3303,0x00},
+    {0x3414,0x05},
+    {0x3416,0x18},
+    {0x341c,0xff},//0x47--12-bit   0xff--10bit
+    {0x341d,0x01},//
+    {0x3648,0x01},
+    {0x364a,0x04},
+    {0x364c,0x04},
+    {0x3678,0x01},
+    {0x367c,0x31},
+    {0x367e,0x31},
+    {0x3706,0x10},
+    {0x3708,0x03},
+    {0x3714,0x02},
+    {0x3715,0x02},
+    {0x3716,0x01},
+    {0x3717,0x03},
+    {0x371c,0x3d},
+    {0x371d,0x3f},
+    {0x372c,0x00},
+    {0x372d,0x00},
+    {0x372e,0x46},
+    {0x372f,0x00},
+    {0x3730,0x89},
+    {0x3731,0x00},
+    {0x3732,0x08},
+    {0x3733,0x01},
+    {0x3734,0xfe},
+    {0x3735,0x05},
+    {0x3740,0x02},
+    {0x375d,0x00},
+    {0x375e,0x00},
+    {0x375f,0x11},
+    {0x3760,0x01},
+    {0x3768,0x1b},
+    {0x3769,0x1b},
+    {0x376a,0x1b},
+    {0x376b,0x1b},
+    {0x376c,0x1a},
+    {0x376d,0x17},
+    {0x376e,0x0f},
+    {0x3776,0x00},
+    {0x3777,0x00},
+    {0x3778,0x46},
+    {0x3779,0x00},
+    {0x377a,0x89},
+    {0x377b,0x00},
+    {0x377c,0x08},
+    {0x377d,0x01},
+    {0x377e,0x23},
+    {0x377f,0x02},
+    {0x3780,0xd9},
+    {0x3781,0x03},
+    {0x3782,0xf5},
+    {0x3783,0x06},
+    {0x3784,0xa5},
+    {0x3788,0x0f},
+    {0x378a,0xd9},
+    {0x378b,0x03},
+    {0x378c,0xeb},
+    {0x378d,0x05},
+    {0x378e,0x87},
+    {0x378f,0x06},
+    {0x3790,0xf5},
+    {0x3792,0x43},
+    {0x3794,0x7a},
+    {0x3796,0xa1},
+    {0x37b0,0x36},
+    {0x3a01,0x03},
+    {0x3a04,0x90},
+    {0x3a05,0x12},
+    {0x3a18,0x8f},
+    {0x3a19,0x00},
+    {0x3a1a,0x4f},
+    {0x3a1b,0x00},
+    {0x3a1c,0x47},
+    {0x3a1d,0x00},
+    {0x3a1e,0x37},
+    {0x3a1f,0x01},
+    {0x3a20,0x4f},
+    {0x3a21,0x00},
+    {0x3a22,0x87},
+    {0x3a23,0x00},
+    {0x3a24,0x4f},
+    {0x3a25,0x00},
+    {0x3a26,0x7f},
+    {0x3a27,0x00},
+    {0x3a28,0x3f},
+    {0x3a29,0x00},
+
+    {0x3000,0x00},
+    {0x3002,0x00},
+#endif
+};
+
+static I2C_ARRAY PatternTbl[] = {
+    {0x308c,0x20}, //colorbar pattern , bit 0 to enable
+};
+
+const static I2C_ARRAY gain_HDR_DOL_LEF_reg[] =
+{
+    {0x30E8, 0x00},// bit0-7 low
+    {0x30E9, 0x00},// bit0-2(8-10)
+};
+
+const static I2C_ARRAY gain_HDR_DOL_SEF1_reg[] =
+{
+    {0x30EA, 0x00},// bit0-7 low
+    {0x30EB, 0x00},// bit0-2(8-10)
+};
+
+const static I2C_ARRAY expo_shr_dol1_reg[] =
+{ //SEL
+   {0x305e, 0x00},  // bit0-3(16-18)
+   {0x305d, 0x00},  // bit0-7(8-15)
+   {0x305c, 0x12},  // bit0-7
+};
+
+const I2C_ARRAY expo_rhs1_reg[] =
+{ //SEL
+   {0x306a, 0x00},  // bit0-3(16-18)
+   {0x3069, 0x00},  // bit0-7(8-15)
+   {0x3068, 0xCE},  // bit0-7
+};
+
+const static I2C_ARRAY mirr_flip_table[] =
+{
+    {0x304e, 0x00},     //M0F0
+    {0x304f, 0x00},     //M0F0
+    {0x3081, 0x02},
+    {0x3083, 0x02},
+    {0x30b6, 0x00},
+    {0x30b7, 0x00},
+    {0x3016, 0x08},
+
+    {0x304e, 0x01},     //M1F0
+    {0x304f, 0x00},     //M1F0
+    {0x3081, 0x02},
+    {0x3083, 0x02},
+    {0x30b6, 0x00},
+    {0x30b7, 0x00},
+    {0x3016, 0x08},
+
+    {0x304e, 0x00},     //M0F1
+    {0x304f, 0x01},     //M0F1
+    {0x3081, 0xfe},
+    {0x3083, 0xfe},
+    {0x30b6, 0xfa},
+    {0x30b7, 0x01},
+    {0x3016, 0x02},
+
+    {0x304e, 0x01},     //M1F1
+    {0x304f, 0x01},     //M1F1
+    {0x3081, 0xfe},
+    {0x3083, 0xfe},
+    {0x30b6, 0xfa},
+    {0x30b7, 0x01},
+    {0x3016, 0x02},
+};
+
+const static I2C_ARRAY gain_reg[] = {
+    {0x30E8, 0x00},// bit0-7 low
+    {0x30E9, 0x00},// bit0-2(8-10)
+};
+
+const static I2C_ARRAY expo_reg[] = {
+   {0x305a, 0x00},  // bit0-3(16-18)
+   {0x3059, 0x00},  // bit0-7(8-15)
+   {0x3058, 0x09},  // bit0-7
+};
+
+const static I2C_ARRAY vts_reg[] = {
+   {0x3032, 0x00},  // bit0-3(16-18)
+   {0x3031, 0x11},  // bit0-7(8-15)
+   {0x3030, 0x94},  // bit0-7
+};
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@@                                               //
+//           @@                                                //
+//          @@                                                 //
+//          @@@                                                //
+//       @   @@                                                //
+//        @@@@                                                 //
+//                                                             //
+//      Step 3 --  complete camera features                    //
+//                                                             //
+//  camera set EV, MWB, orientation, contrast, sharpness       //
+//   , saturation, and Denoise can work correctly.             //
+//                                                             //
+/////////////////////////////////////////////////////////////////
+
+/////////// function definition ///////////////////
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+/////////////////// sensor hardware dependent //////////////
+static int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+/*******I5/I6 Support MCLK List*******
+ *    CUS_CMU_CLK_27MHZ,
+ *    CUS_CMU_CLK_21P6MHZ,
+ *    CUS_CMU_CLK_12MHZ,
+ *    CUS_CMU_CLK_5P4MHZ,
+ *    CUS_CMU_CLK_36MHZ,
+ *    CUS_CMU_CLK_54MHZ,
+ *    CUS_CMU_CLK_43P2MHZ,
+ *    CUS_CMU_CLK_61P7MHZ,
+ *    CUS_CMU_CLK_72MHZ,
+ *    CUS_CMU_CLK_48MHZ,
+ *    CUS_CMU_CLK_24MHZ,
+ *    CUS_CMU_CLK_37P125MHZ,
+ ******End of Support MCLK List*******/
+ #if 0
+static CUS_MCLK_FREQ UseParaMclk(const char *mclk)
+{
+    if (strcmp(mclk, "27M") == 0) {
+        return CUS_CMU_CLK_27MHZ;
+    } else if (strcmp(mclk, "12M") == 0) {
+        return CUS_CMU_CLK_12MHZ;
+    } else if (strcmp(mclk, "36M") == 0) {
+        return CUS_CMU_CLK_36MHZ;
+    } else if (strcmp(mclk, "48M") == 0) {
+        return CUS_CMU_CLK_48MHZ;
+    } else if (strcmp(mclk, "54M") == 0) {
+        return CUS_CMU_CLK_54MHZ;
+    } else if (strcmp(mclk, "24M") == 0) {
+        return CUS_CMU_CLK_24MHZ;
+    } else if (strcmp(mclk, "37.125M") == 0) {
+        return CUS_CMU_CLK_37P125MHZ;
+    }
+    return Preview_MCLK_SPEED;
+}
+#endif
+
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    //Sensor power on sequence
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 1);
+    }
+
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    //Sensor board PWDN Enable, 1.8V & 2.9V need 30ms then Pull High
+    SENSOR_MSLEEP(31);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_UDELAY(1);
+    sensor_if->MCLK(idx, 1, handle->mclk);
+    SENSOR_UDELAY(30);   //modify: clear_OFF->commucation_start>=20us
+    SENSOR_DMSG("Sensor Power On finished\n");
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 0);
+    }
+    handle->orient = SENSOR_ORIT;
+
+    return SUCCESS;
+}
+
+/////////////////// Check Sensor Product ID /////////////////////////
+#if 0
+static int pCus_CheckSensorProductID(ms_cus_sensor *handle)
+{
+    u16 sen_id_msb, sen_id_lsb, sen_data;
+
+    /* Read Product ID */
+    SensorReg_Read(0x3f12, &sen_id_lsb);
+    SensorReg_Read(0x3f13, &sen_id_msb);//CHIP_ID_r3F13
+    sen_data = ((sen_id_lsb & 0x0F) << 8) | (sen_id_lsb & 0xF0) | (sen_id_msb & 0x0F);
+#if 0
+    if (sen_data != CHIP_ID) {
+        printk("[***ERROR***]Check Product ID Fail: 0x%x\n", sen_data);
+        return FAIL;
+    }
+#endif
+    return SUCCESS;
+}
+#endif
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8) table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>2) return FAIL;
+
+      if(/* SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == */SUCCESS) //read sensor ID from I2C
+          break;
+      else
+          SENSOR_MSLEEP(1);
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+      if( id_from_sensor[i].data != Sensor_id_table[i].data )
+        return FAIL;
+      *id = id_from_sensor[i].data;
+    }
+
+    SENSOR_DMSG("[%s]IMX335 sensor ,Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    return SUCCESS;
+}
+
+static int imx335_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+    int i;
+    switch(mode)
+    {
+    case 1:
+        PatternTbl[0].data = 0x21; //enable
+        break;
+    case 0:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+    default:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+      }
+
+    for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+    {
+        if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+        {
+            //MSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+            return FAIL;
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi2lane_5m25fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_2lane_5m25fps);i++)
+    {
+        if(Sensor_init_table_2lane_5m25fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_2lane_5m25fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_2lane_5m25fps[i].reg,Sensor_init_table_2lane_5m25fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi2lane_5m30fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_2lane_5m30fps);i++)
+    {
+        if(Sensor_init_table_2lane_5m30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_2lane_5m30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_2lane_5m30fps[i].reg,Sensor_init_table_2lane_5m30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_5m30fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_5m30fps);i++)
+    {
+        if(Sensor_init_table_4lane_5m30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_5m30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_5m30fps[i].reg,Sensor_init_table_4lane_5m30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_5m25fps_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_5m25fps);i++)
+    {
+        if(Sensor_init_table_4lane_5m25fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_5m25fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_5m25fps[i].reg,Sensor_init_table_4lane_5m25fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane5m25fps_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane5m25fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane5m25fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane5m25fps[i].reg,Sensor_init_table_HDR_DOL_4lane5m25fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane5m20fps_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane5m20fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane5m20fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane5m20fps[i].reg,Sensor_init_table_HDR_DOL_4lane5m20fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane5m30fps_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    SENSOR_DMSG("\n[%s]", __FUNCTION__);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane5m30fps);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane5m30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane5m30fps[i].reg,Sensor_init_table_HDR_DOL_4lane5m30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            if(lane_num == 2){
+                handle->pCus_sensor_init = pCus_init_mipi2lane_5m25fps_linear;
+            }
+            else if (lane_num == 4){
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m25fps_linear;
+            }
+            else{
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m25fps_linear;
+            }
+            vts_30fps = 4950;
+            Preview_MAX_FPS = 25;
+            Preview_line_period  = 8080;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            if(lane_num == 2){
+                handle->pCus_sensor_init = pCus_init_mipi2lane_5m30fps_linear;
+            }
+            else if (lane_num == 4){
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m30fps_linear;
+            }
+            else{
+                handle->pCus_sensor_init = pCus_init_mipi4lane_5m30fps_linear;
+            }
+            vts_30fps  = 4125;
+            Preview_MAX_FPS = 30;
+            Preview_line_period = 8080;
+            break;
+        default:
+            break;
+    }
+    params->expo.vts = vts_30fps;
+    params->expo.fps = Preview_MAX_FPS;
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL_LEF(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+    handle->video_res_supported.ulcur_res = res_idx;
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    //ISensorIfAPI *sensor_if = &handle->sensor_if_api;
+    u32 num_res = handle->video_res_supported.num_res;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_mipi4lane5m25fps_HDR_DOL;
+            vts_30fps_HDR_DOL = 4250;
+            params->expo.vts = vts_30fps_HDR_DOL;
+            Preview_MAX_FPS = 25;
+            params->expo.fps=Preview_MAX_FPS;
+            Preview_line_period_HDR_DOL = 9411; //8889
+            params->max_rhs1 = 290;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            handle->pCus_sensor_init = pCus_init_mipi4lane5m20fps_HDR_DOL;
+            vts_30fps_HDR_DOL = 5312;
+            params->expo.vts = vts_30fps_HDR_DOL;
+            Preview_MAX_FPS = 20;
+            params->expo.fps=Preview_MAX_FPS;
+            Preview_line_period_HDR_DOL = 9411;
+            params->max_rhs1 = 290;
+            break;
+        case 2:
+            handle->video_res_supported.ulcur_res = 2;
+            handle->pCus_sensor_init = pCus_init_mipi4lane5m30fps_HDR_DOL;
+            vts_30fps_HDR_DOL = 4250;
+            params->expo.vts = vts_30fps_HDR_DOL;
+            Preview_MAX_FPS = 30;
+            params->expo.fps= Preview_MAX_FPS;
+            Preview_line_period_HDR_DOL = 7843;
+            params->max_rhs1 = 290;
+            break;
+        default:
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    short Horiz_Inv = 0;
+    short Verti_Inv = 0;
+    short Orien_Mode = 0;
+    SensorReg_Read(0x304e, &Horiz_Inv);
+    SensorReg_Read(0x304f, &Verti_Inv);
+    Horiz_Inv &= 0x01;
+    Verti_Inv &= 0X01;
+    Orien_Mode = Horiz_Inv |(Verti_Inv << 2);
+    switch(Orien_Mode)
+    {
+        case 0x00:
+            *orit = CUS_ORIT_M0F0;
+        break;
+        case 0x01:
+            *orit = CUS_ORIT_M1F0;
+        break;
+        case 0x02:
+            *orit = CUS_ORIT_M0F1;
+        break;
+        case 0x03:
+            *orit = CUS_ORIT_M1F1;
+        break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    handle->orient = orit;
+    params->orien_dirty = true;
+
+    return SUCCESS;
+}
+
+static int DoOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    int table_length = ARRAY_SIZE(mirr_flip_table);
+    int seg_length = table_length/4;
+    int i,j;
+
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            handle->orient = CUS_ORIT_M0F0;
+            for(i = 0, j = 0; i < seg_length; i++, j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+            }
+            break;
+        case CUS_ORIT_M1F0:
+            for(i = seg_length, j = 0; i < seg_length*2; i++, j++){
+                handle->orient = CUS_ORIT_M1F0;
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+            }
+            break;
+        case CUS_ORIT_M0F1:
+            for(i = seg_length * 2, j = 0; i < seg_length*3; i++, j++){
+                handle->orient = CUS_ORIT_M0F1;
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+            }
+            break;
+        case CUS_ORIT_M1F1:
+            for(i = seg_length * 3, j = 0; i < seg_length*4; i++, j++){
+                handle->orient = CUS_ORIT_M1F1;
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+            }
+            break;
+        default :
+            handle->orient = CUS_ORIT_M0F0;
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+    }else if((fps>=(min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts = (vts_30fps*(max_fps*1000) + (fps>>1))/fps;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=25;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > params->expo.vts -2){
+        vts = params->expo.expo_lines + 8;
+    }else{
+        vts = params->expo.vts;
+    }
+    pCus_SetAEUSecs(handle, params->expo.expo_lef_us);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_SEF1(ms_cus_sensor *handle)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_SEF1(ms_cus_sensor *handle, u32 fps)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts = (vts_30fps_HDR_DOL*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts = (vts_30fps_HDR_DOL*(max_fps*1000) + (fps>>1))/fps;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+      return FAIL;
+    }
+    params->dirty = true; //reg need to update = true;
+    pCus_SetAEUSecsHDR_DOL_SEF1(handle, params->expo.expo_sef_us);
+
+    return SUCCESS;
+}
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1);
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+                params->dirty = false;
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_SEF1(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    //imx335_params *params = (imx335_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+            break;
+        case CUS_FRAME_ACTIVE:
+            break;
+        default :
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us)
+{
+    u32 lines = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    lines |= (u32)(params->tExpo_reg[0].data&0xff)<<16;
+    lines |= (u32)(params->tExpo_reg[1].data&0xff)<<8;
+    lines |= (u32)(params->tExpo_reg[2].data&0xff)<<0;
+
+    *us = (lines*Preview_line_period)/1000;
+    SENSOR_DMSG("[%s] sensor expo lines/us %u,%u us\n", __FUNCTION__, lines, *us);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us)
+{
+    u32 lines = 0, vts = 0,activeline = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    params->expo.expo_lef_us = us;
+
+    lines = (1000 * us) / Preview_line_period;
+    if(lines < 9) lines = 9;
+    params->expo.expo_lines = lines;
+
+    if (lines >params->expo.vts-1)
+        vts = lines +1;
+    else
+        vts = params->expo.vts;
+
+    SENSOR_DMSG("[%s] us %u, lines %u, vts %u\n", __FUNCTION__,
+                us,
+                lines,
+                params->expo.vts
+                );
+
+    activeline = vts - lines;
+    if(activeline < 9) activeline = 9;
+
+    params->tExpo_reg[0].data = (activeline>>16) & 0x000f;
+    params->tExpo_reg[1].data = (activeline>>8) & 0x00ff;
+    params->tExpo_reg[2].data = (activeline>>0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x000f;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF1(ms_cus_sensor *handle, u32 us)
+{
+    u32 qua_lines = 0, lines = 0, long_lines = 0,vts = 0, fsc = 0;
+    u32 rhs1 = 0, shs1 = 0, shs0 = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    params->expo.expo_sef_us = us;
+    qua_lines = (1000 * us) / Preview_line_period_HDR_DOL /4;
+    vts = params->expo.vts;
+    shs0 = (params->tExpo_reg[0].data << 16) | (params->tExpo_reg[1].data << 8) | (params->tExpo_reg[2].data << 0);
+    fsc = vts * 2;
+    long_lines = fsc - shs0;
+    params->expo.expo_lines = long_lines;
+
+    //params->max_rhs1 = 290;
+    rhs1 = params->max_rhs1;//(params->tExpo_rhs1_reg[0].data << 16) | (params->tExpo_rhs1_reg[1].data << 8) | (params->tExpo_rhs1_reg[2].data << 0);
+
+    if(qua_lines <= 1)
+        qua_lines = 1;
+    if((4*qua_lines) > (rhs1- 18))
+        qua_lines = (rhs1 - 18)/4;
+
+    lines = 4*qua_lines;
+    if((rhs1 - 18) <= lines){
+        shs1 = 18;
+    }
+    else if((rhs1 <= params->max_rhs1) && (rhs1 <= shs0 - 18)){
+        shs1 = rhs1 - lines;
+        if((shs1 < 18) || (shs1 > (rhs1 - 4))){ //Check boundary
+            //shs1 = 0;
+            //UartSendTrace("[SEF1 NG1]");
+        }
+    }
+    else{
+        //UartSendTrace("[SEF1 NG2]");
+    }
+
+    params->tExpo_shr_dol1_reg[0].data = (shs1 >> 16) & 0x000f;
+    params->tExpo_shr_dol1_reg[1].data = (shs1 >> 8) & 0x00ff;
+    params->tExpo_shr_dol1_reg[2].data = (shs1 >> 0) & 0x00ff;
+    params->tExpo_rhs1_reg[0].data = (rhs1 >> 16) & 0x000f;
+    params->tExpo_rhs1_reg[1].data = (rhs1 >> 8) & 0x00ff;
+    params->tExpo_rhs1_reg[2].data = (rhs1 >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain)
+{
+    unsigned short temp_gain;
+  //  *gain=params->expo.final_gain;
+    temp_gain=gain_reg[0].data;
+
+    *gain=(u32)(10^((temp_gain*3)/200))*1024;
+    if (gain_reg[1].data & 0x10)
+       *gain = (*gain) * 2;
+
+    SENSOR_DMSG("[%s] get gain/reg (1024=1X)= %u/0x%x\n", __FUNCTION__, *gain,gain_reg[0].data);
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    //double gain_double;
+    u64 gain_double;
+    params->expo.final_gain = gain;
+
+    if(gain<1024)
+       gain=1024;
+    else if(gain>=3980*1024)
+        gain=3980*1024;
+
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    params->tGain_reg[0].data=(u16)(((gain_double*10)>> 24)/3);
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u64 gain_double;
+
+    params->expo.final_gain = gain;
+    if(gain < SENSOR_MIN_GAIN)
+        gain = SENSOR_MIN_GAIN;
+    else if(gain >= SENSOR_MAX_GAIN)
+        gain = SENSOR_MAX_GAIN;
+
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    params->tGain_reg[0].data=(u16)(((gain_double*10)>> 24)/3) & 0x00ff;
+    params->tGain_reg[1].data=(u16)((((gain_double*10)>> 24)/3) >> 8) & 0x0007;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data);
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static void pCus_SetAEGainHDR_DOL_Calculate(u32 gain, u16 *gain_reg)
+{
+    //double gain_double;
+    u64 gain_double;
+
+    if(gain < SENSOR_MIN_GAIN){
+      gain = SENSOR_MIN_GAIN;
+    }
+    else if(gain >= SENSOR_MAX_GAIN){
+      gain = SENSOR_MAX_GAIN;
+    }
+    gain_double = 20*(intlog10(gain)-intlog10(1024));
+    *gain_reg=(u16)(((gain_double*10)>> 24)/3) & 0x07ff;
+}
+
+static int pCus_SetAEGainHDR_DOL_SEF1(ms_cus_sensor *handle, u32 gain)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_sef_reg[0].data = gain_reg & 0x00ff;
+    params->tGain_hdr_dol_sef_reg[1].data = (gain_reg>>8) & 0x0007;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_sef_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx335_mipi_linear[0].senout.min_fps;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = SENSOR_MIN_GAIN;//handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;//3980*1024;
+    return SUCCESS;
+}
+
+static int IMX335_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx335_mipi_linear[0].senout.min_fps;
+    info->min = (Preview_line_period * 9);
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+
+    return SUCCESS;
+}
+
+static int IMX335_GetShutterInfoHDR_DOL_SEF1(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    info->max = Preview_line_period_HDR_DOL * params->max_rhs1;
+    info->min = (Preview_line_period_HDR_DOL * 4);
+    info->step = Preview_line_period_HDR_DOL * 4;
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx335_params *params;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx335_params *)handle->private_data;
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    //memcpy(params->tExpo_rhs1_reg, expo_rhs1_reg, sizeof(expo_rhs1_reg));
+    //memcpy(params->tExpo_shr_dol1_reg, expo_shr_dol1_reg, sizeof(expo_shr_dol1_reg));
+    //memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+    //memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF1_reg, sizeof(gain_HDR_DOL_SEF1_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX335_MIPI");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D8;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x34;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //300000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                    = Preview_MCLK_SPEED;//UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+    handle->orient                = SENSOR_ORIT;
+    handle->interface_attr.attr_mipi.mipi_lane_num    = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order   = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode  = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode    = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+   //handle->video_res_supported.num_res = LINEAR_RES_END;
+    for (res = 0; res < LINEAR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx335_mipi_linear[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx335_mipi_linear[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx335_mipi_linear[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx335_mipi_linear[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx335_mipi_linear[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx335_mipi_linear[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx335_mipi_linear[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx335_mipi_linear[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx335_mipi_linear[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release         = cus_camsensor_release_handle;
+    handle->pCus_sensor_init            = pCus_init_mipi4lane_5m30fps_linear;
+    handle->pCus_sensor_poweron         = pCus_poweron;
+    handle->pCus_sensor_poweroff        = pCus_poweroff;
+    handle->pCus_sensor_GetSensorID     = pCus_GetSensorID;
+    handle->pCus_sensor_GetVideoResNum  = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes     = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes     = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien        = pCus_GetOrien;
+    handle->pCus_sensor_SetOrien        = pCus_SetOrien;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS;
+    handle->pCus_sensor_SetPatternMode  = imx335_SetPatternMode;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT;
+    handle->ae_gain_ctrl_num           = 1;
+    handle->ae_shutter_ctrl_num        = 1;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;  //calibration
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = IMX335_GetShutterInfo;
+
+    params->expo.vts        = vts_30fps;
+    params->expo.expo_lines = 5000;
+    params->dirty           = false;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_sef1(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx335_params *params = NULL;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx335_params *)handle->private_data;
+    memcpy(params->tExpo_rhs1_reg, expo_rhs1_reg, sizeof(expo_rhs1_reg));
+    memcpy(params->tExpo_shr_dol1_reg, expo_shr_dol1_reg, sizeof(expo_shr_dol1_reg));
+    memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF1_reg, sizeof(gain_HDR_DOL_SEF1_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX335_MIPI_HDR_SEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                  = Preview_MCLK_SPEED_HDR_DOL;//UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC_DOL;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID_HDR_DOL;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+
+    handle->interface_attr.attr_mipi.mipi_lane_num                = SENSOR_MIPI_LANE_NUM_DOL;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB;
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_SONY_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx335_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx335_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx335_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx335_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx335_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx335_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx335_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx335_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx335_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release        = cus_camsensor_release_handle;
+    handle->pCus_sensor_init           = pCus_init_mipi4lane5m25fps_HDR_DOL;
+    handle->pCus_sensor_poweron        = pCus_poweron;               // Need to check
+    handle->pCus_sensor_poweroff       = pCus_poweroff;
+    handle->pCus_sensor_GetSensorID    = pCus_GetSensorID;
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes_HDR_DOL;
+    handle->pCus_sensor_GetVideoRes    = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes = pCus_GetCurVideoRes;
+
+    handle->pCus_sensor_GetOrien       = pCus_GetOrien;              // Need to check
+    handle->pCus_sensor_SetOrien       = pCus_SetOrien;              // Need to check
+    handle->pCus_sensor_GetFPS         = pCus_GetFPS_HDR_DOL_SEF1;
+    handle->pCus_sensor_SetFPS         = pCus_SetFPS_HDR_DOL_SEF1;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num           = 2;
+    handle->ae_shutter_ctrl_num        = 2;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;      //g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_SEF1;
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+    handle->pCus_sensor_GetShutterInfo  = IMX335_GetShutterInfoHDR_DOL_SEF1;
+    params->expo.vts                    = vts_30fps_HDR_DOL;
+    params->expo.expo_lines             = 4250;
+    return SUCCESS;
+}
+
+//lef functions
+static int pCus_init_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweron_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweroff_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_GetSensorID_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *id)
+{
+    *id = 0;
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_LEF(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps_HDR_DOL*(max_fps*1000))/fps;
+    }else{
+        //params->expo.vts=vts_30fps;
+        //params->expo.fps=30;
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > 2 * params->expo.vts - params->max_rhs1 -18){
+        vts = (params->expo.expo_lines + params->max_rhs1 + 18) / 2;
+    }else{
+        vts = params->expo.vts;
+    }
+
+    pCus_SetAEUSecsHDR_DOL_LEF(handle, params->expo.expo_lef_us);
+
+    return SUCCESS;
+}
+
+static int imx335_SetPatternMode_hdr_dol_lef(ms_cus_sensor *handle,u32 mode)
+{
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty || params->orien_dirty)
+            {
+                SensorReg_Write(0x3001,1);
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_shr_dol1_reg, ARRAY_SIZE(expo_shr_dol1_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tExpo_rhs1_reg, ARRAY_SIZE(expo_rhs1_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_lef_reg, ARRAY_SIZE(gain_HDR_DOL_LEF_reg));
+                SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_sef_reg, ARRAY_SIZE(gain_HDR_DOL_SEF1_reg));
+
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *us)
+{
+    *us = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 qua_lines = 0,lines = 0, half_vts = 0, vts = 0, shr_dol0 = 0, fsc = 0;
+    imx335_params *params = (imx335_params *)handle->private_data;
+
+    qua_lines = (1000 * us) / Preview_line_period_HDR_DOL / 4;
+   // lines=us/Preview_line_period_HDR_DOL;
+    params->expo.expo_lef_us = us;
+
+    if (4 * qua_lines > 2 * params->expo.vts - params->max_rhs1 - 18) { // shs2 > max_rhs1 +2
+        half_vts = (4 * qua_lines + params->max_rhs1 + 19) / 4;
+    }
+    else{
+        half_vts = params->expo.vts / 2;
+    }
+
+    SENSOR_DMSG("[%s] us %u, qua_lines %u, vts %u\n", __FUNCTION__,
+                us,
+                qua_lines,
+                params->expo.vts
+                );
+
+    //exposure limit lines = fsc - (shs2 + 1) = fsc - 1 - ( rhs1 + 2 ~ fsc - 2) = 1 ~ fsc - 104 (rhs1 fix to 101)
+    vts = half_vts * 2;
+    fsc = half_vts * 4;
+    if(qua_lines < 1)  // shs2 < fsc - 2
+        qua_lines = 1;
+    if(4 * qua_lines > fsc - params->max_rhs1 - 18)
+        qua_lines = (fsc - params->max_rhs1 - 18) / 4;
+
+    lines = 4*qua_lines;
+    params->expo.expo_lines = lines;
+
+    shr_dol0 = fsc - lines;
+#if 0
+    printk("[%s] us %u, qua_lines %u, vts %u shr_dol0 %u\n", __FUNCTION__,
+                us,
+                qua_lines,
+                params->expo.vts,
+                shr_dol0
+                );
+#endif
+    params->tExpo_reg[0].data = (shr_dol0 >> 16) & 0x000f;
+    params->tExpo_reg[1].data = (shr_dol0 >> 8) & 0x00ff;
+    params->tExpo_reg[2].data = (shr_dol0 >> 0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x000f;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32* gain)
+{
+    *gain = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGainHDR_DOL_LEF(ms_cus_sensor *handle, u32 gain)
+{
+    imx335_params *params = (imx335_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_lef_reg[0].data = gain_reg & 0x00ff;
+    params->tGain_hdr_dol_lef_reg[1].data = (gain_reg>>8) & 0x0007;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_lef_reg[0].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx335_mipi_linear[0].senout.min_fps;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain_cal_hdr_dol_lef(ms_cus_sensor *handle, u32 gain)
+{
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity_hdr_dol_lef(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num)
+{
+    return SUCCESS;
+}
+
+static int IMX335_GetShutterInfo_hdr_dol_lef(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx335_mipi_linear[0].senout.min_fps;
+    info->min = (Preview_line_period_HDR_DOL * 4);
+    info->step = Preview_line_period_HDR_DOL * 4;
+    return SUCCESS;
+}
+
+static int cus_camsensor_init_handle_hdr_dol_lef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx335_params *params;
+    s32 res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx335_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+    memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX335_MIPI_HDR_LEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                  = Preview_MCLK_SPEED_HDR_DOL;//UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+    //sensor_if->MCLK(0,1,handle->mclk);
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    handle->isp_type               = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt               = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus                = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec              = SENSOR_DATAPREC_DOL;  //CUS_DATAPRECISION_8;
+    handle->data_mode              = SENSOR_DATAMODE;
+    handle->bayer_id               = SENSOR_BAYERID_HDR_DOL;   //CUS_BAYER_GB;
+    handle->RGBIR_id               = SENSOR_RGBIRID;
+    handle->orient                 = SENSOR_ORIT;        //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num                = SENSOR_MIPI_LANE_NUM_DOL;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order               = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_SONY_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num =  0; //Long frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx335_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx335_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx335_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx335_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx335_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx335_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx335_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx335_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx335_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release         = cus_camsensor_release_handle;
+    handle->pCus_sensor_init            = pCus_init_HDR_DOL_LEF;
+    handle->pCus_sensor_poweron         = pCus_poweron_HDR_DOL_LEF;
+    handle->pCus_sensor_poweroff        = pCus_poweroff_HDR_DOL_LEF;
+    handle->pCus_sensor_GetSensorID     = pCus_GetSensorID_HDR_DOL_LEF;
+    handle->pCus_sensor_GetVideoResNum  = pCus_GetVideoResNum;
+    handle->pCus_sensor_SetVideoRes     = pCus_SetVideoRes_HDR_DOL_LEF;
+    handle->pCus_sensor_GetVideoRes     = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+
+    handle->pCus_sensor_GetOrien        = pCus_GetOrien; //pCus_GetOrien_HDR_DOL_LEF
+    handle->pCus_sensor_SetOrien        = pCus_SetOrien; //pCus_SetOrien_HDR_DOL_LEF
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_HDR_DOL_LEF;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_HDR_DOL_LEF;
+
+    handle->pCus_sensor_SetPatternMode  = imx335_SetPatternMode_hdr_dol_lef;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay               = SENSOR_GAIN_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_shutter_delay            = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num            = 2;
+    handle->ae_shutter_ctrl_num         = 2;
+    handle->sat_mingain                 = SENSOR_MIN_GAIN;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain_HDR_DOL_LEF;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal_hdr_dol_lef;
+    handle->pCus_sensor_setCaliData_gain_linearity = pCus_setCaliData_gain_linearity_hdr_dol_lef;
+    handle->pCus_sensor_GetShutterInfo  = IMX335_GetShutterInfo_hdr_dol_lef;
+
+    params->expo.vts                    = vts_30fps_HDR_DOL;
+    params->expo.expo_lines             = 673;
+    params->expo.fps                    = 25;
+    params->dirty                       = false;
+
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(IMX335_HDR,
+                            cus_camsensor_init_handle_linear,
+                            cus_camsensor_init_handle_hdr_dol_sef1,
+                            cus_camsensor_init_handle_hdr_dol_lef,
+                            imx335_params
+                         );
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx347_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx347_mipi.c
new file mode 100644
index 00000000..25eb1639
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx347_mipi.c
@@ -0,0 +1,2199 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+#include <drv_sensor_init_table.h> //TODO: move this header to drv_sensor_common.h
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(IMX347_HDR);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+//#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+//#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE            CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL   CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+#define ENABLE            1
+#define DISABLE           0
+#undef SENSOR_DBG
+#define SENSOR_DBG        1
+
+#define DEBUG_INFO        0
+
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+//#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+///////////////////////////////////////////////////////////////
+//          @@@                                              //
+//         @ @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//          @@@@                                             //
+//                                                           //
+//      Start Step 1 --  show preview on LCM                 //
+//                                                           //
+//  Fill these #define value and table with correct settings //
+//      camera can work and show preview on LCM              //
+//                                                           //
+///////////////////////////////////////////////////////////////
+
+////////////////////////////////////
+// Sensor-If Info                 //
+////////////////////////////////////
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM        (4)
+#define SENSOR_MIPI_LANE_NUM_DOL    (4)
+//#define SENSOR_MIPI_HDR_MODE        (0) //0: Non-HDR mode. 1:Sony DOL mode
+
+#define SENSOR_ISP_TYPE             ISP_EXT             //ISP_EXT, ISP_SOC (Non-used)
+//#define SENSOR_DATAFMT             CUS_DATAFMT_BAYER    //CUS_DATAFMT_YUV, CUS_DATAFMT_BAYER
+#define SENSOR_IFBUS_TYPE           CUS_SENIF_BUS_MIPI  //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE      PACKET_HEADER_EDGE1
+#define SENSOR_MIPI_HSYNC_MODE_HDR_DOL PACKET_FOOTER_EDGE
+#define SENSOR_DATAPREC             CUS_DATAPRECISION_12
+#define SENSOR_DATAPREC_DOL         CUS_DATAPRECISION_12
+#define SENSOR_DATAMODE             CUS_SEN_10TO12_9098  //CFG
+#define SENSOR_BAYERID              CUS_BAYER_RG         //0h: CUS_BAYER_RG, 1h: CUS_BAYER_GR, 2h: CUS_BAYER_BG, 3h: CUS_BAYER_GB
+#define SENSOR_BAYERID_HDR_DOL      CUS_BAYER_RG
+#define SENSOR_RGBIRID              CUS_RGBIR_NONE
+#define SENSOR_ORIT                 CUS_ORIT_M0F0        //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+
+////////////////////////////////////
+// MCLK Info                      //
+////////////////////////////////////
+#define Preview_MCLK_SPEED          CUS_CMU_CLK_24MHZ    //CUS_CMU_CLK_24MHZ //CUS_CMU_CLK_37P125MHZ//CUS_CMU_CLK_27MHZ
+#define Preview_MCLK_SPEED_HDR_DOL  CUS_CMU_CLK_27MHZ
+
+////////////////////////////////////
+// I2C Info                       //
+////////////////////////////////////
+#define SENSOR_I2C_ADDR              0x6e //0x34                //I2C slave address
+#define SENSOR_I2C_SPEED             300000              //200000 //300000 //240000                  //I2C speed, 60000~320000
+//#define SENSOR_I2C_CHANNEL           1                 //I2C Channel
+//#define SENSOR_I2C_PAD_MODE          2                 //Pad/Mode Number
+#define SENSOR_I2C_LEGACY            I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT               I2C_FMT_A16D8       //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+////////////////////////////////////
+// Sensor Signal                  //
+////////////////////////////////////
+#define SENSOR_PWDN_POL              CUS_CLK_POL_NEG     // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL               CUS_CLK_POL_NEG     // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+                                                         // VSYNC/HSYNC POL can be found in data sheet timing diagram,
+                                                         // Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+#define SENSOR_VSYNC_POL             CUS_CLK_POL_NEG     // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL             CUS_CLK_POL_NEG     // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL              CUS_CLK_POL_NEG     // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+////////////////////////////////////
+// Sensor ID                      //
+////////////////////////////////////
+//define SENSOR_ID
+
+#undef SENSOR_NAME
+#define SENSOR_NAME     IMX347
+
+#define CHIP_ID_r3F12   0x3F12
+#define CHIP_ID_r3F13   0x3F13
+#define CHIP_ID         0x0415
+int HDR_Ratio = 16;
+
+////////////////////////////////////
+// Image Info                     //
+////////////////////////////////////
+static struct {     // LINEAR
+    // Modify it based on number of support resolution
+    enum {LINEAR_RES_1 = 0, LINEAR_RES_2, LINEAR_RES_3, LINEAR_RES_END}mode;
+    // Sensor Output Image info
+    struct _senout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _sensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _senstr{
+        const char* strResDesc;
+    }senstr;
+}imx347_mipi_linear[] = {
+    {LINEAR_RES_1, {2712, 1536, 3, 30}, {12, 8, 2688, 1520}, {"2688x1520@30fps"}},
+    {LINEAR_RES_2, {2712, 1536, 3, 30}, {152, 48, 2560, 1440}, {"2560x1440@30fps"}}, // Modify it
+    {LINEAR_RES_3, {2712, 1536, 3, 30}, {396, 228, 1920, 1080}, {"1920x1080@30fps"}}, // Modify it
+};
+
+static struct {     // HDR
+    // Modify it based on number of support resolution
+    enum {HDR_RES_1 = 0, HDR_RES_2, HDR_RES_3, HDR_RES_END}mode;
+    // Sensor Output Image info
+    struct _hsenout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _hsensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _hsenstr{
+        const char* strResDesc;
+    }senstr;
+}imx347_mipi_hdr[] = {
+    {HDR_RES_1, {2712, 1536, 3, 30}, {12, 8, 2688, 1520}, {"2688x1520@30fps_HDR"}}, // Modify it
+    {HDR_RES_2, {2712, 1536, 3, 30}, {152, 48, 2560, 1440}, {"2560x1440@30fps_HDR"}}, // Modify it
+    {HDR_RES_3, {2712, 1536, 3, 30}, {396, 228, 1920, 1080}, {"1920x1080@30fps_HDR"}}, // Modify it
+};
+
+#define IMX347_HDR_BRL                              1650
+
+u32 vts_30fps = 2666;
+u32 vts_30fps_HDR_DOL_4lane = 1650;
+u32 Preview_line_period = 12503;
+u32 Preview_line_period_HDR_DOL_4LANE = 20202;
+
+////////////////////////////////////
+// AE Info                        //
+////////////////////////////////////
+#define SENSOR_MAX_GAIN                             (3981 * 1024)        // max sensor again, a-gain * conversion-gain*d-gain
+#define SENSOR_MIN_GAIN                             (1 * 1024)
+#define SENSOR_GAIN_DELAY_FRAME_COUNT               (2)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT            (2)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL    (2)
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 expo_lines;
+        u32 expo_lef_us;
+        u32 expo_sef_us;
+    } expo;
+    u32 min_shr1;
+    u32 min_rhs1;
+    u32 min_shr0;
+    u32 max_shr0;
+    u32 fsc;
+    I2C_ARRAY tVts_reg[3];
+    I2C_ARRAY tVts_reg_hdr[3];
+    I2C_ARRAY tExpo_reg[3];
+    I2C_ARRAY tSHR0_reg[3];
+    I2C_ARRAY tSHR1_reg[3];
+    I2C_ARRAY tRHS1_reg[3];
+    I2C_ARRAY tGain_reg[2];
+    I2C_ARRAY tGain_hdr_dol_lef_reg[2];
+    I2C_ARRAY tGain_hdr_dol_sef_reg[2];
+    bool dirty;
+    bool orien_dirty;
+} imx347_params;
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_SEF(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us);
+///////////////////////////////////////////////////////////////
+//          @@@                                              //
+//         @  @@                                             //
+//           @@                                              //
+//          @@                                               //
+//         @@@@@                                             //
+//                                                           //
+//      Start Step 2 --  set Sensor initial and              //
+//                       adjust parameter                    //
+//  Fill these register table with resolution settings       //
+//      camera can work and show preview on LCM              //
+//                                                           //
+///////////////////////////////////////////////////////////////
+const static I2C_ARRAY Sensor_init_table_4lane_linear[] =
+{
+/*
+IMX347LQR All-pixel scan AD:12bit Output:12bit CSI-2_4lane 720Mbps INCK_24MHz Master Mode LCG Mode 50fps Integration Time 10ms Gain:6dB
+Tool ver : Ver2.0
+*/
+    {0x3000, 0x01},//Standby
+    {0x3002, 0x01},//Master mode stopx
+    {0x300C, 0x3B},// BCWAIT_TIME[7:0]
+    {0x300D, 0x2A},// CPWAIT_TIME[7:0]
+    {0x3030, 0x40},// VMAX[19:0]
+
+    {0x3056, 0x00},//y_out_size lsb 0x02
+    {0x3057, 0x06},//y_out_size msb 0x06
+
+    {0x3058, 0x20},// SHR0[19:0]
+    {0x3059, 0x03},// 
+    {0x30BE, 0x5E},// -
+    {0x30C6, 0x00},// BLACK_OFSET_ADR[12:0]
+    {0x30CE, 0x00},// UNRD_LINE_MAX[12:0]
+    {0x30D8, 0x4F},// UNREAD_ED_ADR[12:0]
+    {0x30D9, 0x64},// 
+    {0x30E8, 0x14},// GAIN[10:0]
+    {0x3110, 0x02},// -
+    {0x314C, 0xF0},// INCKSEL1[8:0]
+    {0x315A, 0x06},// INCKSEL2[1:0]
+    {0x3168, 0x82},// INCKSEL3[7:0]
+    {0x316A, 0x7E},// INCKSEL4[1:0]
+    {0x319E, 0x02},// SYS_MODE[1:0]
+    {0x31A1, 0x00},// XVS_DRV[1:0]
+    {0x3202, 0x02},// -
+    {0x3288, 0x22},// -
+    {0x328A, 0x02},// -
+    {0x328C, 0xA2},// -
+    {0x328E, 0x22},// -
+    {0x3415, 0x27},// -
+    {0x3418, 0x27},// -
+    {0x3428, 0xFE},// -
+    {0x349E, 0x6A},// -
+    {0x34A2, 0x9A},// -
+    {0x34A4, 0x8A},// -
+    {0x34A6, 0x8E},// -
+    {0x34AA, 0xD8},// -
+    {0x3648, 0x01},// -
+    {0x3678, 0x01},// -
+    {0x367C, 0x69},// -
+    {0x367E, 0x69},// -
+    {0x3680, 0x69},// -
+    {0x3682, 0x69},// -
+    {0x371D, 0x05},// -
+    {0x375D, 0x11},// -
+    {0x375E, 0x43},// -
+    {0x375F, 0x76},// -
+    {0x3760, 0x07},// -
+    {0x3768, 0x1B},// -
+    {0x3769, 0x1B},// -
+    {0x376A, 0x1A},// -
+    {0x376B, 0x19},// -
+    {0x376C, 0x17},// -
+    {0x376D, 0x0F},// -
+    {0x376E, 0x0B},// -
+    {0x376F, 0x0B},// -
+    {0x3770, 0x0B},// -
+    {0x3776, 0x89},// -
+    {0x3777, 0x00},// -
+    {0x3778, 0xCA},// -
+    {0x3779, 0x00},// -
+    {0x377A, 0x45},// -
+    {0x377B, 0x01},// -
+    {0x377C, 0x56},// -
+    {0x377D, 0x02},// -
+    {0x377E, 0xFE},// -
+    {0x377F, 0x03},// -
+    {0x3780, 0xFE},// -
+    {0x3781, 0x05},// -
+    {0x3782, 0xFE},// -
+    {0x3783, 0x06},// -
+    {0x3784, 0x7F},// -
+    {0x3788, 0x1F},// -
+    {0x378A, 0xCA},// -
+    {0x378B, 0x00},// -
+    {0x378C, 0x45},// -
+    {0x378D, 0x01},// -
+    {0x378E, 0x56},// -
+    {0x378F, 0x02},// -
+    {0x3790, 0xFE},// -
+    {0x3791, 0x03},// -
+    {0x3792, 0xFE},// -
+    {0x3793, 0x05},// -
+    {0x3794, 0xFE},// -
+    {0x3795, 0x06},// -
+    {0x3796, 0x7F},// -
+    {0x3798, 0xBF},// -
+    {0x3A18, 0x6F},// TCLKPOST[9:0]
+    {0x3A1A, 0x2F},// TCLKPREPARE[9:0]
+    {0x3A1C, 0x2F},// TCLKTRAIL[9:0]
+    {0x3A1E, 0xBF},// TCLKZERO[9:0]
+    {0x3A1F, 0x00},// 
+    {0x3A20, 0x2F},// THSPREPARE[9:0]
+    {0x3A22, 0x57},// THSZERO[9:0]
+    {0x3A24, 0x2F},// THSTRAIL[9:0]
+    {0x3A26, 0x4F},// THSEXIT[9:0]
+    {0x3A28, 0x27},// TLPX[9:0]
+    {0x3000, 0x00},// STANDBY Release
+    {0x3002, 0x00},// MASTER MODE Start
+};
+
+const static I2C_ARRAY Sensor_init_table_4lane_HDR_DOL[] =
+{
+    /*
+        IMX347LQR All-pixel scan 
+        CSI-2_4lane 
+        27MHz
+        AD:12bit Output:12bit 
+        1188Mbps 
+        Master Mode LCG Mode DOL HDR 2frame VC 
+        30fps 
+        Integration Time LEF:32ms SEF:0.202ms
+        Tool ver : Ver2.0
+    */
+    {0x3000, 0x01},//Standby
+    {0x3002, 0x01},//Master mode stopx
+    {0x300C, 0x42},// BCWAIT_TIME[7:0]
+    {0x300D, 0x2E},// CPWAIT_TIME[7:0]
+    {0x3048, 0x01},// WDMODE[0]
+    {0x3049, 0x01},// WDSEL[1:0]
+    {0x304A, 0x04},// WD_SET1[2:0]
+    {0x304B, 0x04},// WD_SET2[3:0]
+    {0x304C, 0x13},// OPB_SIZE_V[5:0]
+
+    {0x3056, 0x00},//y_out_size lsb 0x02
+    {0x3057, 0x06},//y_out_size msb 0x06
+
+    {0x3058, 0x84},// SHR0[19:0]
+    {0x3068, 0x1D},// RHS1[19:0]
+    {0x30BE, 0x5E},
+    {0x3110, 0x02},
+    {0x314C, 0xB0},// INCKSEL1[8:0]
+    {0x315A, 0x02},// INCKSEL2[1:0]
+    {0x3168, 0x8F},// INCKSEL3[7:0]
+    {0x316A, 0x7E},// INCKSEL4[1:0]
+    {0x31A1, 0x00},// XVS_DRV[1:0]
+    {0x31D7, 0x01},// XVSMSKCNT_INT[1:0]
+    {0x3202, 0x02},
+    {0x3288, 0x22},
+    {0x328A, 0x02},
+    {0x328C, 0xA2},
+    {0x328E, 0x22},
+    {0x3415, 0x27},
+    {0x3418, 0x27},
+    {0x3428, 0xFE},
+    {0x349E, 0x6A},
+    {0x34A2, 0x9A},
+    {0x34A4, 0x8A},
+    {0x34A6, 0x8E},
+    {0x34AA, 0xD8},
+    {0x3648, 0x01},
+    {0x3678, 0x01},
+    {0x367C, 0x69},
+    {0x367E, 0x69},
+    {0x3680, 0x69},
+    {0x3682, 0x69},
+    {0x371D, 0x05},
+    {0x375D, 0x11},
+    {0x375E, 0x43},
+    {0x375F, 0x76},
+    {0x3760, 0x07},
+    {0x3768, 0x1B},
+    {0x3769, 0x1B},
+    {0x376A, 0x1A},
+    {0x376B, 0x19},
+    {0x376C, 0x17},
+    {0x376D, 0x0F},
+    {0x376E, 0x0B},
+    {0x376F, 0x0B},
+    {0x3770, 0x0B},
+    {0x3776, 0x89},
+    {0x3777, 0x00},
+    {0x3778, 0xCA},
+    {0x3779, 0x00},
+    {0x377A, 0x45},
+    {0x377B, 0x01},
+    {0x377C, 0x56},
+    {0x377D, 0x02},
+    {0x377E, 0xFE},
+    {0x377F, 0x03},
+    {0x3780, 0xFE},
+    {0x3781, 0x05},
+    {0x3782, 0xFE},
+    {0x3783, 0x06},
+    {0x3784, 0x7F},
+    {0x3788, 0x1F},
+    {0x378A, 0xCA},
+    {0x378B, 0x00},
+    {0x378C, 0x45},
+    {0x378D, 0x01},
+    {0x378E, 0x56},
+    {0x378F, 0x02},
+    {0x3790, 0xFE},
+    {0x3791, 0x03},
+    {0x3792, 0xFE},
+    {0x3793, 0x05},
+    {0x3794, 0xFE},
+    {0x3795, 0x06},
+    {0x3796, 0x7F},
+    {0x3798, 0xBF},
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},    //Master mode start
+    {0x3260, 0x00},    //Gain_Pgc_Fidmd
+};
+
+const static I2C_ARRAY Sensor_id_table[] = {
+    {0x3F12, 0x14},      // {address of ID, ID },
+    {0x3F13, 0x75},      // {address of ID, ID },
+};
+
+static I2C_ARRAY PatternTbl[] = {
+    {0x0000,0x00},       // colorbar pattern , bit 0 to enable
+};
+
+const static I2C_ARRAY expo_reg[] = {      // SHS0 (For Linear)
+    {0x305a, 0x00},
+    {0x3059, 0x00},
+    {0x3058, 0x08},
+};
+
+const static I2C_ARRAY expo_SHR0_reg[] = { // SHS0 (For LEF)
+    {0x305a, 0x00},
+    {0x3059, 0x00},
+    {0x3058, 0x84},
+};
+
+const static I2C_ARRAY expo_SHR1_reg[] = { // SHS1 (For SEF)
+    //decreasing exposure ratio version.
+    {0x305e, 0x00},
+    {0x305d, 0x00},
+    {0x305c, 0x09},
+};
+
+const static I2C_ARRAY vts_reg[] = {       //VMAX
+    {0x3032, 0x00}, //bit0-3-->MSB
+    {0x3031, 0x06},
+    {0x3030, 0x72},
+};
+
+const static I2C_ARRAY vts_reg_hdr[] = {
+    {0x3032, 0x00}, //bit0-3-->MSB
+    {0x3031, 0x06},
+    {0x3030, 0x72},
+};
+
+const I2C_ARRAY expo_RHS1_reg[] = {
+    //decreasing exposure ratio version.
+    {0x306a, 0x00},
+    {0x3069, 0x00},
+    {0x3068, 0x1d},
+};
+
+const static I2C_ARRAY gain_reg[] = {
+    {0x30e8, 0x2A},//low bit
+    {0x30e9, 0x00},//hcg mode,bit 4
+};
+
+const static I2C_ARRAY gain_HDR_DOL_LEF_reg[] = {
+    {0x30e8, 0x2A},
+    {0x30e9, 0x00},
+};
+
+const static I2C_ARRAY gain_HDR_DOL_SEF_reg[] = {
+    {0x30ea, 0x20},
+    {0x30eb, 0x00},
+};
+
+const static I2C_ARRAY mirr_flip_table[] =
+{
+    {0x304e, 0x00},//M0F0
+    {0x304f, 0x00},
+    {0x304e, 0x01},//M1F0
+    {0x304f, 0x00},
+    {0x304e, 0x00},//M0F1
+    {0x304f, 0x01},
+    {0x304e, 0x01},//M1F1
+    {0x304f, 0x01},
+};
+
+//static int g_sensor_ae_min_gain = 1024;
+static CUS_GAIN_GAP_ARRAY gain_gap_compensate[16] = {  //compensate  gain gap
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0}
+};
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@@                                               //
+//           @@                                                //
+//          @@                                                 //
+//          @@@                                                //
+//       @   @@                                                //
+//        @@@@                                                 //
+//                                                             //
+//      Step 3 --  complete camera features                    //
+//                                                             //
+//  camera set EV, MWB, orientation, contrast, sharpness       //
+//   , saturation, and Denoise can work correctly.             //
+//                                                             //
+/////////////////////////////////////////////////////////////////
+
+#if 0
+static CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////////////// I2C function definition ///////////////////
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+/////////////////// sensor hardware dependent ///////////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+/*******I5/I6 Support MCLK List*******
+ *    CUS_CMU_CLK_27MHZ,
+ *    CUS_CMU_CLK_21P6MHZ,
+ *    CUS_CMU_CLK_12MHZ,
+ *    CUS_CMU_CLK_5P4MHZ,
+ *    CUS_CMU_CLK_36MHZ,
+ *    CUS_CMU_CLK_54MHZ,
+ *    CUS_CMU_CLK_43P2MHZ,
+ *    CUS_CMU_CLK_61P7MHZ,
+ *    CUS_CMU_CLK_72MHZ,
+ *    CUS_CMU_CLK_48MHZ,
+ *    CUS_CMU_CLK_24MHZ,
+ *    CUS_CMU_CLK_37P125MHZ,
+ ******End of Support MCLK List*******/
+ #if 0
+static CUS_MCLK_FREQ UseParaMclk(const char *mclk)
+{
+    if (strcmp(mclk, "27M") == 0) {
+        return CUS_CMU_CLK_27MHZ;
+    } else if (strcmp(mclk, "12M") == 0) {
+        return CUS_CMU_CLK_12MHZ;
+    } else if (strcmp(mclk, "36M") == 0) {
+        return CUS_CMU_CLK_36MHZ;
+    } else if (strcmp(mclk, "48M") == 0) {
+        return CUS_CMU_CLK_48MHZ;
+    } else if (strcmp(mclk, "54M") == 0) {
+        return CUS_CMU_CLK_54MHZ;
+    } else if (strcmp(mclk, "24M") == 0) {
+        return CUS_CMU_CLK_24MHZ;
+    } else if (strcmp(mclk, "37.125M") == 0) {
+        return CUS_CMU_CLK_37P125MHZ;
+    }
+    return Preview_MCLK_SPEED;
+}
+#endif
+
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    //Sensor power on sequence
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);   // Powerdn Pull Low
+    sensor_if->Reset(idx, handle->reset_POLARITY);     // Rst Pull Low
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, ENABLE);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 1);
+    }
+
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    //Sensor board PWDN Enable, 1.8V & 2.9V need 30ms then Pull High
+    SENSOR_MSLEEP(31);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_MSLEEP(2);
+    sensor_if->MCLK(idx, 1, handle->mclk);
+    SENSOR_MSLEEP(2);
+    SENSOR_DMSG("Sensor Power On finished\n");
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);   // Powerdn Pull Low
+    sensor_if->Reset(idx, handle->reset_POLARITY);     // Rst Pull Low
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 0);
+    }
+
+    handle->orient = SENSOR_ORIT;
+
+    return SUCCESS;
+}
+
+/////////////////// Check Sensor Product ID /////////////////////////
+/* static int pCus_CheckSensorProductID(ms_cus_sensor *handle)
+{
+    u16 sen_id_msb, sen_id_lsb;
+
+    //Read Product ID
+    SensorReg_Read(0x3f12, (void*)&sen_id_lsb);
+    SensorReg_Read(0x3f13, (void*)&sen_id_msb);//CHIP_ID_r3F13
+#if 0
+    if (sen_data != CHIP_ID) {
+        printk("[***ERROR***]Check Product ID Fail: 0x%x\n", sen_data);
+        return FAIL;
+    }
+#endif
+    return SUCCESS;
+} */
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8)
+        table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>3)
+          return FAIL;
+
+      if(SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+          break;
+      else
+          SENSOR_MSLEEP(1);
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+       if( id_from_sensor[i].data != Sensor_id_table[i].data ){
+            SENSOR_DMSG("[%s] Please Check IMX347 Sensor Insert!!\n", __FUNCTION__);
+            return FAIL;
+       }
+       *id = id_from_sensor[i].data;
+    }
+
+    SENSOR_DMSG("[%s]IMX347 sensor ,Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    return SUCCESS;
+}
+
+static int imx347_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+    int i;
+    switch(mode)
+    {
+    case 1:
+        PatternTbl[0].data = 0x21; //enable
+        break;
+    case 0:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+    default:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+    }
+    for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+    {
+        if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+        {
+            SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+            return FAIL;
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx347_params *params = (imx347_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+/*     if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    } */
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_linear);i++)
+    {
+        if(Sensor_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_4lane_linear[i].reg);
+                //printk("IMX347 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    //imx347_params *params = (imx347_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+/*     if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    } */
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_HDR_DOL[i].reg,Sensor_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_HDR_DOL[i].reg, Sensor_init_table_4lane_HDR_DOL[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_4lane_HDR_DOL[i].reg, &sen_data );
+            if(Sensor_init_table_4lane_linear[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_init_table_4lane_HDR_DOL[i].reg);
+                //printk("IMX347 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane_HDR_DOL[i].reg, Sensor_init_table_4lane_HDR_DOL[i].data, sen_data);
+#endif
+        }
+    }
+
+    SENSOR_DMSG("Sensor IMX347 HDR MODE Initial Finished\n");
+    return SUCCESS;
+}
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    handle->video_res_supported.ulcur_res = res_idx;
+
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear;
+            vts_30fps = 2666;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period = 12503;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear;
+            vts_30fps = 2666;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period = 12503;
+            break;
+        case 2:
+            handle->video_res_supported.ulcur_res = 2;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear;
+            vts_30fps = 2666;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period = 12503;
+            break;
+        default:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear;
+            vts_30fps = 2666;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period = 12503;
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL_LEF(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    handle->video_res_supported.ulcur_res = res_idx;
+
+    switch (res_idx) {
+        case HDR_RES_1:
+        case HDR_RES_2:
+        case HDR_RES_3:
+            handle->data_prec = CUS_DATAPRECISION_12;
+            break;
+        default:
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL_SEF(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    handle->video_res_supported.ulcur_res = res_idx;
+
+    switch (res_idx) {
+        case HDR_RES_1:
+            handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 1650;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 20202;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            params->min_rhs1 = 101;
+            break;
+        case HDR_RES_2:
+            handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 1650;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 20202;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            params->min_rhs1 = 101;
+            break;
+        case HDR_RES_3:
+            handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 1650;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 20202;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            params->min_rhs1 = 101;
+            break;
+        default:
+            handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 1650;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 20202;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            params->min_rhs1 = 101;
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+
+    *orit = handle->orient;
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+
+    handle->orient = orit;
+    params->orien_dirty = true;
+
+    return SUCCESS;
+}
+
+static int DoOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    int table_length = ARRAY_SIZE(mirr_flip_table);
+    int seg_length=table_length/4;
+    int i,j;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            for(i=0,j=0;i<seg_length;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                SensorReg_Write(0x3080,0x01);
+                SensorReg_Write(0x30ad,0x02);
+                SensorReg_Write(0x30b6,0x00);
+                SensorReg_Write(0x30b7,0x00);
+                SensorReg_Write(0x30d8,0x44);
+                SensorReg_Write(0x3110,0x02);
+                SensorReg_Write(0x3114,0x01);
+                handle->orient = CUS_ORIT_M0F0;
+            }
+            break;
+        case CUS_ORIT_M1F0:
+            for(i=seg_length,j=0;i<seg_length*2;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                SensorReg_Write(0x3080,0x01);
+                SensorReg_Write(0x30ad,0x02);
+                SensorReg_Write(0x30b6,0x00);
+                SensorReg_Write(0x30b7,0x00);
+                SensorReg_Write(0x30d8,0x44);
+                SensorReg_Write(0x3110,0x02);
+                SensorReg_Write(0x3114,0x01);
+                handle->orient = CUS_ORIT_M1F0;
+            }
+            break;
+        case CUS_ORIT_M0F1:
+            for(i=seg_length*2,j=0;i<seg_length*3;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                SensorReg_Write(0x3080,0xff);
+                SensorReg_Write(0x30ad,0x7e);
+                SensorReg_Write(0x30b6,0xff);
+                SensorReg_Write(0x30b7,0x01);
+                SensorReg_Write(0x30d8,0x45);
+                SensorReg_Write(0x3110,0x02);
+                SensorReg_Write(0x3114,0x01);
+                handle->orient = CUS_ORIT_M0F1;
+            }
+            break;
+        case CUS_ORIT_M1F1:
+            for(i=seg_length*3,j=0;i<seg_length*4;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                SensorReg_Write(0x3080,0xff);
+                SensorReg_Write(0x30ad,0x7e);
+                SensorReg_Write(0x30b6,0xff);
+                SensorReg_Write(0x30b7,0x01);
+                SensorReg_Write(0x30d8,0x45);
+                SensorReg_Write(0x3110,0x02);
+                SensorReg_Write(0x3114,0x01);
+                handle->orient = CUS_ORIT_M1F1;
+            }
+            break;
+        default :
+            for(i=0,j=0;i<seg_length;i++,j++){
+                SensorReg_Write(mirr_flip_table[i].reg,mirr_flip_table[i].data);
+                SensorReg_Write(0x3080,0x01);
+                SensorReg_Write(0x30ad,0x02);
+                SensorReg_Write(0x30b6,0x00);
+                SensorReg_Write(0x30b7,0x00);
+                SensorReg_Write(0x30d8,0x44);
+                SensorReg_Write(0x3110,0x02);
+                SensorReg_Write(0x3114,0x01);
+                handle->orient = CUS_ORIT_M0F0;
+            }
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    //u32 vts = 0, cur_vts_30fps = 0;
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    if(fps>=min_fps && fps <= max_fps)
+    {
+       params->expo.vts=  (vts_30fps*(max_fps*1000) + fps * 500)/(fps * 1000);
+    }else if(fps>=(min_fps*1000) && fps <= (max_fps*1000))
+    {
+        params->expo.vts=  (vts_30fps*(max_fps*1000) + (fps>>1))/fps;
+    }else
+    {
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    //pr_info("[%s]  leslie_vts : %u\n\n", __FUNCTION__,params->expo.vts);
+    if(params->expo.expo_lines > params->expo.vts - 4){
+        //vts = params->expo.expo_lines + 4;
+#if 0        //Update FPS Status
+        if(fps>=3 && fps <= 30)
+            fps = (vts_30fps*30000)/(params->expo.vts * 1000 - 500);
+        else if(fps>=3000 && fps <= 30000)
+            fps = (vts_30fps*30000)/(params->expo.vts - (500 / 1000));
+#endif
+    }else{
+        //vts = params->expo.vts;
+    }
+
+    params->expo.fps = fps;
+    params->dirty = true;
+
+    pCus_SetAEUSecs(handle, params->expo.expo_lef_us);
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_SEF(ms_cus_sensor *handle)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (cur_vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (cur_vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_SEF(ms_cus_sensor *handle, u32 fps)
+{
+    u32 cur_vts_30fps = 0;
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+
+    cur_vts_30fps=vts_30fps_HDR_DOL_4lane;
+    if(fps>=min_fps && fps <= max_fps)
+    {
+        params->expo.vts= (cur_vts_30fps*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+    }else if(fps>=(min_fps*1000) && fps <= (max_fps*1000))
+    {
+        params->expo.vts= (cur_vts_30fps*(max_fps*1000) + (fps >> 1))/fps;
+    }else
+    {
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > params->expo.vts - 4){
+        //vts = params->expo.expo_lines + 4;
+#if 0        //Update FPS Status
+        if(fps>=3 && fps <= 30)
+            fps = (vts_30fps*30000)/(params->expo.vts * 1000 - 500);
+        else if(fps>=3000 && fps <= 30000)
+            fps = (vts_30fps*30000)/(params->expo.vts - (500 / 1000));
+#endif
+    }else{
+        //vts = params->expo.vts;
+    }
+
+    params->expo.fps = fps;
+    //params->expo.vts = vts;
+    params->dirty = true;
+
+    pCus_SetAEUSecsHDR_DOL_SEF(handle, params->expo.expo_sef_us);
+    return SUCCESS;
+}
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1); // Global hold on
+                if(params->dirty) {
+                    SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                    params->dirty = false;
+                }
+
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0); // Global hold off
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_SEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    //imx347_params *params = (imx347_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             break;
+        case CUS_FRAME_ACTIVE:
+#if 0
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1);
+
+                if(params->dirty) {
+                    //SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                    //SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                    //SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                    params->dirty = false;
+                }
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+            }
+#endif
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us)
+{
+    u32 lines = 0;
+    imx347_params *params = (imx347_params *)handle->private_data;
+
+    lines |= (u32)(params->tExpo_reg[0].data & 0x03) << 16;
+    lines |= (u32)(params->tExpo_reg[1].data & 0xff) << 8;
+    lines |= (u32)(params->tExpo_reg[2].data & 0xff) << 0;
+
+    *us = (lines * Preview_line_period) / 1000;
+
+    SENSOR_DMSG("[%s] sensor expo lines/us %u,%u us\n", __FUNCTION__, lines, *us);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us)
+{
+    u32 expo_lines = 0, vts = 0, SHR0 = 0;
+    imx347_params *params = (imx347_params *)handle->private_data;
+
+    params->expo.expo_lef_us = us;
+    expo_lines = (1000*us)/Preview_line_period;
+
+    if (expo_lines > params->expo.vts) {
+        vts = expo_lines + 8;
+    }
+    else
+      vts = params->expo.vts;
+    SHR0 =  vts - expo_lines;
+
+    if (SHR0 <= 12 )  // 8+4
+        SHR0 = 8;
+    else
+        SHR0 -= 4;
+
+    params->expo.expo_lines = expo_lines;
+    //params->expo.vts = vts;
+
+    SENSOR_DMSG("[%s] us %u, SHR0 %u, vts %u\n", __FUNCTION__,
+                                                 us,  \
+                                                 SHR0, \
+                                                 vts
+               );
+    //pr_info("[%s]  leslie_shutter,expo_lines,params_expo_lines : %d,%d,%d\n\n", __FUNCTION__,us,expo_lines,params->expo.expo_lines);
+    //pr_info("[%s]  leslie_shutter_vts : %u,%u\n\n", __FUNCTION__,params->expo.vts,vts);
+    params->tExpo_reg[0].data = (SHR0>>16) & 0x0003;
+    params->tExpo_reg[1].data = (SHR0>>8) & 0x00ff;
+    params->tExpo_reg[2].data = (SHR0>>0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 expo_line_sef = 0;
+    u32 cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    imx347_params *params = (imx347_params *)handle->private_data;
+
+    cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    expo_line_sef = (1000 * us + (cur_line_period >> 1)) / cur_line_period;
+    params->expo.expo_sef_us = us;
+    //params->min_rhs1 = 437;     // 4n+1 fix to 269, 337 //5ms: 429
+
+    params->min_shr1 = params->min_rhs1 - expo_line_sef;
+    if((expo_line_sef > params->min_rhs1) || ((params->min_shr1) <  9))
+        params->min_shr1 = 9;
+    params->min_shr1 = ((params->min_shr1 >> 1) << 1) + 1;
+
+    SENSOR_DMSG("[%s] us %u, expo_line_sef %u rhs %u shr1 %u\n", __FUNCTION__,
+                                                                 us, \
+                                                                 expo_line_sef, \
+                                                                 params->min_rhs1, \
+                                                                 params->min_shr1
+               );
+
+    params->tRHS1_reg[0].data = (params->min_rhs1 >>16) & 0x03;
+    params->tRHS1_reg[1].data = (params->min_rhs1 >>8) & 0xff;
+    params->tRHS1_reg[2].data = (params->min_rhs1 >>0) & 0xff;
+
+    params->tSHR1_reg[0].data = (params->min_shr1 >> 16) & 0x0003;
+    params->tSHR1_reg[1].data = (params->min_shr1 >> 8) & 0x00ff;
+    params->tSHR1_reg[2].data = (params->min_shr1 >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+#if 0
+    u16 temp_gain;
+
+    temp_gain=gain_reg[0].data;
+    *gain=(u32)(10^((temp_gain*3)/200))*1024;
+    if (gain_reg[1].data & 0x10)
+       *gain = (*gain) * 2;
+#endif
+    *gain = params->expo.final_gain;
+    SENSOR_DMSG("[%s] get gain %u\n", __FUNCTION__, *gain);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 i;
+    CUS_GAIN_GAP_ARRAY* Sensor_Gain_Linearity;
+    u64 gain_double;
+
+    params->expo.final_gain = gain;
+    if(gain < SENSOR_MIN_GAIN)
+        gain = SENSOR_MIN_GAIN;
+    else if(gain >= SENSOR_MAX_GAIN)
+        gain = SENSOR_MAX_GAIN;
+
+    Sensor_Gain_Linearity = gain_gap_compensate;
+
+    for(i = 0; i < sizeof(gain_gap_compensate)/sizeof(CUS_GAIN_GAP_ARRAY); i++){
+        if (Sensor_Gain_Linearity[i].gain == 0)
+            break;
+        if((gain>Sensor_Gain_Linearity[i].gain) && (gain < (Sensor_Gain_Linearity[i].gain + Sensor_Gain_Linearity[i].offset))){
+              gain=Sensor_Gain_Linearity[i].gain;
+              break;
+        }
+    }
+    gain_double = 20 * (intlog10(gain) - intlog10(1024));
+    gain_double = (u16)((gain_double * 10) >> 24) / 3;
+
+    params->tGain_reg[0].data = gain_double & 0xff;
+    params->tGain_reg[1].data = (gain_double >> 8) & 0xff;
+
+#if DEBUG_INFO
+    SENSOR_DMSG("[%s]gain %u gain_double %llu\n",__FUNCTION__, gain, gain_double);
+#endif
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x 0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data, gain,params->tGain_reg[1].dat);
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static void pCus_SetAEGainHDR_DOL_Calculate(u32 gain, u16 *gain_reg)
+{
+    //double gain_double;
+    u64 gain_double;
+
+    if(gain < SENSOR_MIN_GAIN){
+      gain = SENSOR_MIN_GAIN;
+    }
+    else if(gain >= SENSOR_MAX_GAIN){
+      gain = SENSOR_MAX_GAIN;
+    }
+    gain_double = 20 * (intlog10(gain) - intlog10(1024));
+    *gain_reg =(u16)((gain_double * 10) >> 24) / 3;
+}
+
+static int pCus_SetAEGainHDR_DOL_SEF1(ms_cus_sensor *handle, u32 gain)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_sef_reg[0].data = gain_reg & 0xff;
+    params->tGain_hdr_dol_sef_reg[1].data = (gain_reg >> 8) & 0xff;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x 0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_sef_reg[0].data, params->tGain_hdr_dol_sef_reg[1].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx347_mipi_linear[0].senout.min_fps;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = SENSOR_MIN_GAIN;//handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;//10^(72db/20)*1024;
+    return SUCCESS;
+}
+
+static int IMX347_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx347_mipi_linear[0].senout.min_fps;//
+    info->min = (Preview_line_period * 1);
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+
+static int IMX347_GetShutterInfo_HDR_DOL_SEF(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    info->max = Preview_line_period_HDR_DOL_4LANE * params->min_rhs1;
+    info->min = (Preview_line_period_HDR_DOL_4LANE * 2);
+    info->step = Preview_line_period_HDR_DOL_4LANE;
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx347_params *params;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx347_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX347_MIPI");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D8;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x34;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //300000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                    =Preview_MCLK_SPEED;
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+    handle->orient                = SENSOR_ORIT;
+    //handle->YC_ODER               = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num    = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order   = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode  = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode    = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+   //handle->video_res_supported.num_res = LINEAR_RES_END;
+    for (res = 0; res < LINEAR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx347_mipi_linear[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx347_mipi_linear[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx347_mipi_linear[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx347_mipi_linear[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx347_mipi_linear[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx347_mipi_linear[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx347_mipi_linear[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx347_mipi_linear[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx347_mipi_linear[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY              = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY             = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY             = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY             = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->PCLK_POLARITY              = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release        = cus_camsensor_release_handle;
+    handle->pCus_sensor_init           = pCus_init_mipi4lane_linear;
+    //handle->pCus_sensor_powerupseq     = pCus_powerupseq;
+    handle->pCus_sensor_poweron        = pCus_poweron;
+    handle->pCus_sensor_poweroff       = pCus_poweroff;
+    handle->pCus_sensor_GetSensorID    = pCus_GetSensorID;
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes    = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien       = pCus_GetOrien;
+    handle->pCus_sensor_SetOrien       = pCus_SetOrien;
+    handle->pCus_sensor_GetFPS         = pCus_GetFPS;
+    handle->pCus_sensor_SetFPS         = pCus_SetFPS;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = imx347_SetPatternMode; //NONE
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT;
+    handle->ae_gain_ctrl_num           = 1;
+    handle->ae_shutter_ctrl_num        = 1;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;//g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    //sensor calibration
+    //handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    //handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo  = IMX347_GetShutterInfo;
+
+    params->expo.vts = vts_30fps;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_sef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx347_params *params = NULL;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx347_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg_hdr, sizeof(vts_reg_hdr));
+    memcpy(params->tRHS1_reg, expo_RHS1_reg, sizeof(expo_RHS1_reg));
+    memcpy(params->tSHR1_reg, expo_SHR1_reg, sizeof(expo_SHR1_reg));
+    memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF_reg, sizeof(gain_HDR_DOL_SEF_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX347_MIPI_HDR_SEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                  = Preview_MCLK_SPEED_HDR_DOL;
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC_DOL;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID_HDR_DOL;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+
+    handle->interface_attr.attr_mipi.mipi_lane_num                = 4; // hdr_lane_num;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB;
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_DCG;  // SONY IMX347 as VC mode
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    //handle->video_res_supported.num_res = HDR_RES_END;
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx347_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx347_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx347_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx347_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx347_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx347_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx347_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx347_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx347_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY              = SENSOR_PWDN_POL;      //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY             = SENSOR_RST_POL;       //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY             = SENSOR_VSYNC_POL;     //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY             = SENSOR_HSYNC_POL;     //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY              = SENSOR_PCLK_POL;      //CUS_CLK_POL_POS);  // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release        = cus_camsensor_release_handle;
+    handle->pCus_sensor_init           = pCus_init_mipi4lane_HDR_DOL;
+    handle->pCus_sensor_poweron        = pCus_poweron;               // Need to check
+    handle->pCus_sensor_poweroff       = pCus_poweroff;              // Need to check
+    handle->pCus_sensor_GetSensorID    = pCus_GetSensorID;           // Need to check
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes_HDR_DOL_SEF;   // Need to check
+    handle->pCus_sensor_GetVideoRes    = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes = pCus_GetCurVideoRes;
+
+    handle->pCus_sensor_GetOrien       = pCus_GetOrien;              // Need to check
+    handle->pCus_sensor_SetOrien       = pCus_SetOrien;              // Need to check
+    handle->pCus_sensor_GetFPS         = pCus_GetFPS_HDR_DOL_SEF;    // Need to check
+    handle->pCus_sensor_SetFPS         = pCus_SetFPS_HDR_DOL_SEF;    // Need to check
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num           = 2;
+    handle->ae_shutter_ctrl_num        = 2;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;      //g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_SEF;  // Need to check
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_SEF;      // Need to check
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_SEF1;      // Need to check
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    handle->pCus_sensor_GetShutterInfo  = IMX347_GetShutterInfo_HDR_DOL_SEF;
+    params->expo.vts = vts_30fps_HDR_DOL_4lane;
+
+    return SUCCESS;
+}
+
+//lef functions
+static int pCus_init_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweron_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweroff_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_GetSensorID_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *id)
+{
+     return SUCCESS;
+}
+
+static int pCus_GetOrien_HDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    return SUCCESS;
+}
+
+static int pCus_SetOrien_HDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+
+    handle->orient = orit;
+    params->orien_dirty = true;
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (cur_vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (cur_vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_LEF(ms_cus_sensor *handle, u32 fps)
+{
+    u32 cur_vts_30fps = 0;//vts = 0,
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+   // cur_vts_30fps = imx347_mipi_hdr[0].senout.height;
+    cur_vts_30fps=vts_30fps_HDR_DOL_4lane;
+    if(fps>=min_fps && fps <= max_fps)
+    {
+        params->expo.vts=  (cur_vts_30fps*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+    }else if(fps>=(min_fps*1000) && fps <= (max_fps*1000))
+    {
+        params->expo.vts=  (cur_vts_30fps*(max_fps*1000) + (fps >> 1))/fps;
+    }else {
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > params->expo.vts - 4) {
+        //vts = params->expo.expo_lines + 4;
+    }else {
+        //vts = params->expo.vts;
+    }
+
+    params->dirty = true;
+    params->expo.fps = fps;
+    pCus_SetAEUSecsHDR_DOL_LEF(handle, params->expo.expo_sef_us);
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+
+             break;
+        case CUS_FRAME_ACTIVE:
+
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1);
+                if(params->dirty) {
+                    SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg_hdr));
+                    SensorRegArrayW((I2C_ARRAY*)params->tSHR0_reg, ARRAY_SIZE(expo_SHR0_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tSHR1_reg, ARRAY_SIZE(expo_SHR1_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tRHS1_reg, ARRAY_SIZE(expo_RHS1_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_lef_reg, ARRAY_SIZE(gain_HDR_DOL_LEF_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_sef_reg, ARRAY_SIZE(gain_HDR_DOL_SEF_reg));
+                    params->dirty = false;
+                }
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *us)
+{
+    *us = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 expo_lines_lef = 0, vts = 0, fsc = 0;
+    u32 cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    imx347_params *params = (imx347_params *)handle->private_data;
+    cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    expo_lines_lef = (1000 * us + (cur_line_period >> 1)) / cur_line_period;
+
+    params->expo.expo_lef_us = us;
+    fsc = params->expo.vts * 2;
+    params->fsc = ((fsc >> 2) << 2)+ 4;                  // 4n
+
+    //params->max_shr0 = fsc - expo_lines_lef - 8;
+    params->max_shr0 = (fsc - 8) - expo_lines_lef;
+    if(params->max_shr0 < (params->min_rhs1+9))
+        params->max_shr0 = params->min_rhs1+9;
+    params->max_shr0 = ((params->max_shr0 >> 1) << 1) + 2; //2n
+
+    if (expo_lines_lef > (fsc - params->min_rhs1 - 9)) {
+        vts = (expo_lines_lef + params->min_rhs1 + 9) / 2;
+    }
+    else{
+        vts = params->expo.vts;
+    }
+    params->expo.expo_lines = expo_lines_lef;
+    //params->expo.vts = vts;
+
+    SENSOR_DMSG("[%s] us %u, expo_lines_lef %u, vts %u, SHR0 %u \n", __FUNCTION__,
+                                                                     us, \
+                                                                     expo_lines_lef, \
+                                                                     vts, \
+                                                                     params->max_shr0
+                );
+    params->tSHR0_reg[0].data = (params->max_shr0 >> 16) & 0x0003;
+    params->tSHR0_reg[1].data = (params->max_shr0 >> 8) & 0x00ff;
+    params->tSHR0_reg[2].data = (params->max_shr0 >> 0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32* gain)
+{
+    *gain = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGainHDR_DOL_LEF(ms_cus_sensor *handle, u32 gain)
+{
+    imx347_params *params = (imx347_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_lef_reg[0].data = gain_reg & 0xff;
+    params->tGain_hdr_dol_lef_reg[1].data = (gain_reg >> 8) & 0xff;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_lef_reg[0].data, params->tGain_hdr_dol_lef_reg[1].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx347_mipi_hdr[0].senout.min_fps;
+    return SUCCESS;
+}
+
+#if 0
+//static int pCus_GetDGainRemainder(ms_cus_sensor *handle, u32 *dgain_remainder)
+//{
+//    *dgain_remainder = handle->dgain_remainder;
+
+//    return SUCCESS;
+//}
+
+static int pCus_SetAEGain_cal_hdr_dol_lef(ms_cus_sensor *handle, u32 gain)
+{
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity_hdr_dol_lef(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num)
+{
+    return SUCCESS;
+}
+#endif
+
+static int IMX347_GetShutterInfo_HDR_DOL_LEF(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx347_mipi_hdr[0].senout.min_fps;
+    info->min = (Preview_line_period_HDR_DOL_4LANE * 2);
+    info->step = Preview_line_period_HDR_DOL_4LANE;
+    return SUCCESS;
+}
+
+static int cus_camsensor_init_handle_hdr_dol_lef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx347_params *params;
+    s32 res;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx347_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg_hdr, sizeof(vts_reg_hdr));
+    memcpy(params->tSHR0_reg, expo_SHR0_reg, sizeof(expo_SHR0_reg));
+    memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX347_MIPI_HDR_LEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+      handle->mclk                   =Preview_MCLK_SPEED_HDR_DOL;
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //handle->isp_type             = SENSOR_ISP_TYPE;    //ISP_SOC;
+    //handle->data_fmt             = SENSOR_DATAFMT;     //CUS_DATAFMT_YUV;
+    handle->sif_bus                = SENSOR_IFBUS_TYPE;  //CUS_SENIF_BUS_PARL;
+    handle->data_prec              = SENSOR_DATAPREC_DOL;  //CUS_DATAPRECISION_8;
+    handle->data_mode              = SENSOR_DATAMODE;
+    handle->bayer_id               = SENSOR_BAYERID_HDR_DOL;   //CUS_BAYER_GB;
+    handle->RGBIR_id               = SENSOR_RGBIRID;
+    handle->orient                 = SENSOR_ORIT;        //CUS_ORIT_M1F1;
+    //handle->YC_ODER                = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num                = 4;//hdr_lane_num;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order               = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_DCG;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Long frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    //handle->video_res_supported.num_res = HDR_RES_END;
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx347_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx347_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx347_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx347_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx347_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx347_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx347_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx347_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx347_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY              = SENSOR_PWDN_POL;      //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY             = SENSOR_RST_POL;       //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY             = SENSOR_VSYNC_POL;     //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY             = SENSOR_HSYNC_POL;     //CUS_CLK_POL_POS;
+    //handle->PCLK_POLARITY              = SENSOR_PCLK_POL;      //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release         = cus_camsensor_release_handle;
+    handle->pCus_sensor_init            = pCus_init_HDR_DOL_LEF;
+    //handle->pCus_sensor_powerupseq      = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron         = pCus_poweron_HDR_DOL_LEF;
+    handle->pCus_sensor_poweroff        = pCus_poweroff_HDR_DOL_LEF;
+    handle->pCus_sensor_GetSensorID     = pCus_GetSensorID_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetVideoResNum  = NULL;
+    //handle->pCus_sensor_GetVideoRes     = NULL;
+    //handle->pCus_sensor_GetCurVideoRes  = NULL;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes_HDR_DOL_LEF;   // Need to check
+
+
+    handle->pCus_sensor_GetOrien        = pCus_GetOrien_HDR_DOL_LEF;
+    handle->pCus_sensor_SetOrien        = pCus_SetOrien_HDR_DOL_LEF;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_HDR_DOL_LEF;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap_hdr_dol_lef;
+    //handle->pCus_sensor_SetPatternMode  = imx347_SetPatternMode_hdr_dol_lef;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay               = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay            = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num            = 2;
+    handle->ae_shutter_ctrl_num         = 2;
+    handle->sat_mingain                 = SENSOR_MIN_GAIN;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_LEF;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain_HDR_DOL_LEF;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    handle->pCus_sensor_GetShutterInfo  = IMX347_GetShutterInfo_HDR_DOL_LEF;
+
+    params->expo.vts = vts_30fps_HDR_DOL_4lane;
+
+    params->dirty = false;
+
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(IMX347_HDR,
+                            cus_camsensor_init_handle_linear,
+                            cus_camsensor_init_handle_hdr_dol_sef,
+                            cus_camsensor_init_handle_hdr_dol_lef,
+                            imx347_params
+                         );
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx415_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx415_mipi.c
new file mode 100644
index 00000000..e4e46c0b
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_imx415_mipi.c
@@ -0,0 +1,5391 @@
+/* Copyright (c) 2018-2019 Sigmastar Technology Corp.
+ All rights reserved.
+
+ Unless otherwise stipulated in writing, any and all information contained
+herein regardless in any format shall remain the sole proprietary of
+Sigmastar Technology Corp. and be kept in strict confidence
+(Sigmastar Confidential Information) by the recipient.
+Any unauthorized act including without limitation unauthorized disclosure,
+copying, use, reproduction, sale, distribution, modification, disassembling,
+reverse engineering and compiling of the contents of Sigmastar Confidential
+Information is unlawful and strictly prohibited. Sigmastar hereby reserves the
+rights to any and all damages, losses, costs and expenses resulting therefrom.
+*/
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+#include <drv_sensor_init_table.h> //TODO: move this header to drv_sensor_common.h
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(IMX415_HDR);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+//#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+//#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE            CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL   CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+#define ENABLE            1
+#define DISABLE           0
+#undef SENSOR_DBG
+#define SENSOR_DBG        0
+
+#define DEBUG_INFO        0
+
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) LOGD(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+//#define SENSOR_DMSG(args...) printf(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+///////////////////////////////////////////////////////////////
+//          @@@                                              //
+//         @ @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//           @@      ==  S t a r t * H e r e  ==             //
+//          @@@@                                             //
+//                                                           //
+//      Start Step 1 --  show preview on LCM                 //
+//                                                           //
+//  Fill these #define value and table with correct settings //
+//      camera can work and show preview on LCM              //
+//                                                           //
+///////////////////////////////////////////////////////////////
+
+////////////////////////////////////
+// Sensor-If Info                 //
+////////////////////////////////////
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM        (4)
+#define SENSOR_MIPI_LANE_NUM_DOL    (4)
+//#define SENSOR_MIPI_HDR_MODE        (0) //0: Non-HDR mode. 1:Sony DOL mode
+
+#define SENSOR_ISP_TYPE             ISP_EXT             //ISP_EXT, ISP_SOC (Non-used)
+//#define SENSOR_DATAFMT             CUS_DATAFMT_BAYER    //CUS_DATAFMT_YUV, CUS_DATAFMT_BAYER
+#define SENSOR_IFBUS_TYPE           CUS_SENIF_BUS_MIPI  //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE      PACKET_HEADER_EDGE1
+#define SENSOR_MIPI_HSYNC_MODE_HDR_DOL PACKET_FOOTER_EDGE
+#define SENSOR_DATAPREC             CUS_DATAPRECISION_10
+#define SENSOR_DATAPREC_DOL         CUS_DATAPRECISION_12
+#define SENSOR_DATAMODE             CUS_SEN_10TO12_9098  //CFG
+#define SENSOR_BAYERID              CUS_BAYER_GB         //0h: CUS_BAYER_RG, 1h: CUS_BAYER_GR, 2h: CUS_BAYER_BG, 3h: CUS_BAYER_GB
+#define SENSOR_BAYERID_HDR_DOL      CUS_BAYER_GB
+#define SENSOR_RGBIRID              CUS_RGBIR_NONE
+#define SENSOR_ORIT                 CUS_ORIT_M0F0        //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+//#define SENSOR_YCORDER              CUS_SEN_YCODR_YC     //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+//#define long_packet_type_enable     0x00 //UD1~UD8 (user define)
+
+////////////////////////////////////
+// MCLK Info                      //
+////////////////////////////////////
+#define Preview_MCLK_SPEED          CUS_CMU_CLK_27MHZ    //CUS_CMU_CLK_24MHZ //CUS_CMU_CLK_37P125MHZ//CUS_CMU_CLK_27MHZ
+#define Preview_MCLK_SPEED_HDR_DOL  CUS_CMU_CLK_27MHZ
+
+////////////////////////////////////
+// I2C Info                       //
+////////////////////////////////////
+#define SENSOR_I2C_ADDR              0x34                //I2C slave address
+#define SENSOR_I2C_SPEED             300000              //200000 //300000 //240000                  //I2C speed, 60000~320000
+//#define SENSOR_I2C_CHANNEL           1                 //I2C Channel
+//#define SENSOR_I2C_PAD_MODE          2                 //Pad/Mode Number
+#define SENSOR_I2C_LEGACY            I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT               I2C_FMT_A16D8       //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+////////////////////////////////////
+// Sensor Signal                  //
+////////////////////////////////////
+#define SENSOR_PWDN_POL              CUS_CLK_POL_NEG     // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL               CUS_CLK_POL_NEG     // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+                                                         // VSYNC/HSYNC POL can be found in data sheet timing diagram,
+                                                         // Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+#define SENSOR_VSYNC_POL             CUS_CLK_POL_NEG     // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL             CUS_CLK_POL_NEG     // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL              CUS_CLK_POL_NEG     // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+////////////////////////////////////
+// Sensor ID                      //
+////////////////////////////////////
+//define SENSOR_ID
+
+#undef SENSOR_NAME
+#define SENSOR_NAME     IMX415
+
+#define CHIP_ID_r3F12   0x3F12
+#define CHIP_ID_r3F13   0x3F13
+#define CHIP_ID         0x0415
+
+////////////////////////////////////
+// Image Info                     //
+////////////////////////////////////
+static struct {     // LINEAR
+    // Modify it based on number of support resolution
+    enum {LINEAR_RES_1 = 0, LINEAR_RES_2, LINEAR_RES_3, LINEAR_RES_4, LINEAR_RES_5, LINEAR_RES_6, LINEAR_RES_7, LINEAR_RES_8, LINEAR_RES_END}mode;
+    // Sensor Output Image info
+    struct _senout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _sensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _senstr{
+        const char* strResDesc;
+    }senstr;
+}imx415_mipi_linear[] = {
+    {LINEAR_RES_1, {3860, 2250, 3, 20}, {12, 16, 3840, 2160}, {"3840x2160@20fps"}},
+    {LINEAR_RES_2, {3096, 2190, 3, 30}, {0, 0, 3072, 2048}, {"3072x2048@30fps"}}, // Modify it
+    {LINEAR_RES_3, {3096, 1758, 3, 30}, {0, 0, 3072, 1728}, {"3072x1728@30fps"}}, // Modify it
+    {LINEAR_RES_4, {2616, 1974, 3, 30}, {0, 0, 2592, 1944}, {"2592x1944@30fps"}}, // Modify it
+    {LINEAR_RES_5, {2976, 1686, 3, 30}, {0, 0, 2944, 1656}, {"2944x1656@30fps"}}, // Modify it
+    {LINEAR_RES_6, {2592, 1470, 3, 30}, {0, 0, 2560, 1440}, {"2560x1440@30fps"}}, // Modify it
+    {LINEAR_RES_7, {1920, 1080, 3, 60}, {0, 0, 1920, 1080}, {"1920x1080@60fps"}}, // Modify it
+    {LINEAR_RES_8, {1280, 720, 3, 120}, {0, 0, 1280,  720}, {"1280x720@120fps"}}, // Modify it
+};
+
+static struct {     // HDR
+    // Modify it based on number of support resolution
+    enum {HDR_RES_1 = 0, HDR_RES_2, HDR_RES_3, HDR_RES_4, HDR_RES_5, HDR_RES_6, HDR_RES_7, HDR_RES_END}mode;
+    // Sensor Output Image info
+    struct _hsenout{
+        s32 width, height, min_fps, max_fps;
+    }senout;
+    // VIF Get Image Info
+    struct _hsensif{
+        s32 crop_start_X, crop_start_y, preview_w, preview_h;
+    }senif;
+    // Show resolution string
+    struct _hsenstr{
+        const char* strResDesc;
+    }senstr;
+}imx415_mipi_hdr[] = {
+    {HDR_RES_1, {3864, 2192, 3, 15}, {0, 0, 3840, 2160}, {"3840x2160@15fps_HDR"}}, // Modify it
+    {HDR_RES_2, {3864, 2192, 3, 20}, {0, 0, 3840, 2160}, {"3840x2160@20fps_HDR"}}, // Modify it
+    {HDR_RES_3, {3864, 2192, 3, 30}, {0, 0, 3840, 2160}, {"3840x2160@30fps_HDR"}}, // Modify it
+    {HDR_RES_4, {2592, 1944, 3, 30}, {0, 0, 2592, 1944}, {"2592x1944@30fps_HDR"}}, // Modify it
+    {HDR_RES_5, {2976, 1688, 3, 30}, {0, 0, 2944, 1656}, {"2944x1656@30fps_HDR"}}, // Modify it
+    {HDR_RES_6, {2688, 1520, 3, 30}, {0, 0, 2688, 1520}, {"2688x1520@30fps_HDR"}}, // Modify it
+    {HDR_RES_7, {1920, 1080, 3, 30}, {0, 0, 1920, 1080}, {"1920x1080@30fps_HDR"}}, // Modify it
+};
+
+#define IMX415_HDR_BRL                              2228
+
+u32 vts_30fps = 2250;
+u32 vts_30fps_HDR_DOL_4lane = 2250;
+u32 Preview_line_period = 17778;
+u32 Preview_line_period_HDR_DOL_4LANE = 29630;
+
+////////////////////////////////////
+// AE Info                        //
+////////////////////////////////////
+#define SENSOR_MAX_GAIN                             (3981 * 1024)        // max sensor again, a-gain * conversion-gain*d-gain
+#define SENSOR_MIN_GAIN                             (1 * 1024)
+#define SENSOR_GAIN_DELAY_FRAME_COUNT               (2)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT            (2)
+#define SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL    (2)
+
+////////////////////////////////////
+// Mirror-Flip Info               //
+////////////////////////////////////
+#define MIRROR_FLIP                                 0x3030
+#define SENSOR_NOR                                  0x0
+#define SENSOR_MIRROR_EN                            0x1 << (0)
+#define SENSOR_FLIP_EN                              0x1 << (1)
+#define SENSOR_MIRROR_FLIP_EN                       0x3
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+    struct {
+        float sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 fps;
+        u32 preview_fps;
+        u32 expo_lines;
+        u32 expo_lef_us;
+        u32 expo_sef_us;
+    } expo;
+
+    u32 min_shr1;
+    u32 min_rhs1;
+    u32 min_shr0;
+    u32 max_shr0;
+    u32 fsc;
+    I2C_ARRAY tVts_reg[3];
+    I2C_ARRAY tVts_reg_hdr[3];
+    I2C_ARRAY tExpo_reg[3];
+    I2C_ARRAY tSHR0_reg[3];
+    I2C_ARRAY tSHR1_reg[3];
+    I2C_ARRAY tRHS1_reg[3];
+    I2C_ARRAY tGain_reg[2];
+    I2C_ARRAY tGain_hdr_dol_lef_reg[2];
+    I2C_ARRAY tGain_hdr_dol_sef_reg[2];
+    bool dirty;
+    bool orien_dirty;
+} imx415_params;
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_SEF(ms_cus_sensor *handle, u32 us);
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us);
+///////////////////////////////////////////////////////////////
+//          @@@                                              //
+//         @  @@                                             //
+//           @@                                              //
+//          @@                                               //
+//         @@@@@                                             //
+//                                                           //
+//      Start Step 2 --  set Sensor initial and              //
+//                       adjust parameter                    //
+//  Fill these register table with resolution settings       //
+//      camera can work and show preview on LCM              //
+//                                                           //
+///////////////////////////////////////////////////////////////
+const static I2C_ARRAY Sensor_init_table_4lane_linear[] =
+{
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008, 0x7F},    //BCwait time
+    {0x3009, 0x00},
+    {0x300A, 0x5B},
+    {0x300B, 0xA0},
+    //{0x3023, 0x0},
+    {0x3024, 0xCA},    //VMAX LSB
+    {0x3025, 0x08},    //VMAX MSB     8CAh: 2250
+    {0x3026, 0x00},    //VMAX MSB [0:3]
+    {0x3028, 0x4C},    //HMAX LSB
+    {0x3029, 0x04},    //HMAX MSB     44Ch: 1100
+    {0x3031, 0x00},    //ADBIT    0h: AD 10bit; 1h: AD 12bit
+    {0x3032, 0x00},    //MDBIT    0h: 10bit; 1h: 12bit
+    {0x3033, 0x05},    //SYS MODE 05h: 891Mbps
+    {0x3050, 0x08},    //SHR0 Shutter Setting
+    {0x3051, 0x00},
+    {0x3052, 0x00},
+    {0x30C0, 0x2A},    //XVSOUTSEL
+    {0x30C1, 0x00},
+    {0x30CC, 0x00},
+    {0x30CD, 0x00},
+    {0x30CF, 0x00},    //DOL setting
+    {0x3116, 0x24},    //INCKSEL2
+    {0x311E, 0x24},    //INCKSEL5
+    {0x32D4, 0x21},
+    {0x32EC, 0xA1},
+    {0x3452, 0x7F},
+    {0x3453, 0x03},
+    {0x358A, 0x04},
+    {0x35A1, 0x02},
+    {0x36BC, 0x0C},
+    {0x36CC, 0x53},
+    {0x36CD, 0x00},
+    {0x36CE, 0x3C},
+    {0x36D0, 0x8C},
+    {0x36D1, 0x00},
+    {0x36D2, 0x71},
+    {0x36D4, 0x3C},
+    {0x36D6, 0x53},
+    {0x36D7, 0x00},
+    {0x36D8, 0x71},
+    {0x36DA, 0x8C},
+    {0x36DB, 0x00},
+    {0x37D1, 0x00},    //ADBIT1
+    {0x3724, 0x02},
+    {0x3726, 0x02},
+    {0x3732, 0x02},
+    {0x3734, 0x03},
+    {0x3736, 0x03},
+    {0x3742, 0x03},
+    {0x3862, 0xE0},
+    {0x38CC, 0x30},
+    {0x38CD, 0x2F},
+    {0x395C, 0x0C},
+    {0x3A42, 0xD1},
+    {0x3A4C, 0x77},
+    {0x3AE0, 0x02},
+    {0x3AEC, 0x0C},
+    {0x3B00, 0x2E},
+    {0x3B06, 0x29},
+    {0x3B98, 0x25},
+    {0x3B99, 0x21},
+    {0x3B9B, 0x13},
+    {0x3B9C, 0x13},
+    {0x3B9D, 0x13},
+    {0x3B9E, 0x13},
+    {0x3BA1, 0x00},
+    {0x3BA2, 0x06},
+    {0x3BA3, 0x0B},
+    {0x3BA4, 0x10},
+    {0x3BA5, 0x14},
+    {0x3BA6, 0x18},
+    {0x3BA7, 0x1A},
+    {0x3BA8, 0x1A},
+    {0x3BA9, 0x1A},
+    {0x3BAC, 0xED},
+    {0x3BAD, 0x01},
+    {0x3BAE, 0xF6},
+    {0x3BAF, 0x02},
+    {0x3BB0, 0xA2},
+    {0x3BB1, 0x03},
+    {0x3BB2, 0xE0},
+    {0x3BB3, 0x03},
+    {0x3BB4, 0xE0},
+    {0x3BB5, 0x03},
+    {0x3BB6, 0xE0},
+    {0x3BB7, 0x03},
+    {0x3BB8, 0xE0},
+    {0x3BBA, 0xE0},
+    {0x3BBC, 0xDA},
+    {0x3BBE, 0x88},
+    {0x3BC0, 0x44},
+    {0x3BC2, 0x7B},
+    {0x3BC4, 0xA2},
+    {0x3BC8, 0xBD},
+    {0x3BCA, 0xBD},
+    {0x4004, 0x48},    //TXCLKSEC_FREQ LSB
+    {0x4005, 0x09},    //TXCLKSEC_FREQ MSB
+    {0x400C, 0x00},
+    {0x4018, 0x7F},    //TCLKPOST    MIPI global setting
+    {0x401A, 0x37},    //TCLKPREPARE MIPI global setting
+    {0x401C, 0x37},    //TCLKTRAIL   MIPI global setting
+    {0x401E, 0xF7},    //TCLKZERO    MIPI global setting
+    {0x401F, 0x00},    //TCLKZERO
+    {0x4020, 0x3F},    //THSPREPARE
+    {0x4022, 0x6F},    //THSZERO
+    {0x4024, 0x3F},    //THSTRAIL
+    {0x4026, 0x5F},    //THSEXT
+    {0x4028, 0x2F},    //TLPX
+    {0x4074, 0x01},
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+//8M20 594Mbps, 10bits, Mclk 27M
+const static I2C_ARRAY Sensor_8m_20fps_init_table_4lane_linear[] =
+{
+    /*
+    IMX415-AAQR All-pixel scan CSI-2_4lane 27MHz AD:10bit Output:10bit 594Mbps Master Mode 19.996fps Integration Time 49.86ms
+    Tool ver : Ver6.0  hts:1320  vts:2813
+    */
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008,0x5D},    // BCWAIT_TIME[9:0]
+    {0x300A,0x42},    // CPWAIT_TIME[9:0]
+    {0x3024,0xFD},    // VMAX[19:0]
+    {0x3025,0x0A},    //
+    {0x3028,0x28},    // HMAX[15:0]
+    {0x3029,0x05},    //
+    {0x3031,0x00},    // ADBIT[1:0]
+    {0x3032,0x00},    // MDBIT
+    {0x3033,0x07},    // SYS_MODE[3:0]
+    {0x3050,0x08},    // SHR0[19:0]
+    {0x30C1,0x00},    // XVS_DRV[1:0]
+    {0x3116,0x23},    // INCKSEL2[7:0]
+    {0x3118,0x84},    // INCKSEL3[10:0]
+    {0x311A,0xE7},    // INCKSEL4[10:0]
+    {0x311E,0x23},    // INCKSEL5[7:0]
+    {0x32D4,0x21},    // -
+    {0x32EC,0xA1},    // -
+    {0x3452,0x7F},    // -
+    {0x3453,0x03},    // -
+    {0x358A,0x04},    // -
+    {0x35A1,0x02},    // -
+    {0x36BC,0x0C},    // -
+    {0x36CC,0x53},    // -
+    {0x36CD,0x00},    // -
+    {0x36CE,0x3C},    // -
+    {0x36D0,0x8C},    // -
+    {0x36D1,0x00},    // -
+    {0x36D2,0x71},    // -
+    {0x36D4,0x3C},    // -
+    {0x36D6,0x53},    // -
+    {0x36D7,0x00},    // -
+    {0x36D8,0x71},    // -
+    {0x36DA,0x8C},    // -
+    {0x36DB,0x00},    // -
+    {0x3701,0x00},    // ADBIT1[7:0]
+    {0x3724,0x02},    // -
+    {0x3726,0x02},    // -
+    {0x3732,0x02},    // -
+    {0x3734,0x03},    // -
+    {0x3736,0x03},    // -
+    {0x3742,0x03},    // -
+    {0x3862,0xE0},    // -
+    {0x38CC,0x30},    // -
+    {0x38CD,0x2F},    // -
+    {0x395C,0x0C},    // -
+    {0x3A42,0xD1},    // -
+    {0x3A4C,0x77},    // -
+    {0x3AE0,0x02},    // -
+    {0x3AEC,0x0C},    // -
+    {0x3B00,0x2E},    // -
+    {0x3B06,0x29},    // -
+    {0x3B98,0x25},    // -
+    {0x3B99,0x21},    // -
+    {0x3B9B,0x13},    // -
+    {0x3B9C,0x13},    // -
+    {0x3B9D,0x13},    // -
+    {0x3B9E,0x13},    // -
+    {0x3BA1,0x00},    // -
+    {0x3BA2,0x06},    // -
+    {0x3BA3,0x0B},    // -
+    {0x3BA4,0x10},    // -
+    {0x3BA5,0x14},    // -
+    {0x3BA6,0x18},    // -
+    {0x3BA7,0x1A},    // -
+    {0x3BA8,0x1A},    // -
+    {0x3BA9,0x1A},    // -
+    {0x3BAC,0xED},    // -
+    {0x3BAD,0x01},    // -
+    {0x3BAE,0xF6},    // -
+    {0x3BAF,0x02},    // -
+    {0x3BB0,0xA2},    // -
+    {0x3BB1,0x03},    // -
+    {0x3BB2,0xE0},    // -
+    {0x3BB3,0x03},    // -
+    {0x3BB4,0xE0},    // -
+    {0x3BB5,0x03},    // -
+    {0x3BB6,0xE0},    // -
+    {0x3BB7,0x03},    // -
+    {0x3BB8,0xE0},    // -
+    {0x3BBA,0xE0},    // -
+    {0x3BBC,0xDA},    // -
+    {0x3BBE,0x88},    // -
+    {0x3BC0,0x44},    // -
+    {0x3BC2,0x7B},    // -
+    {0x3BC4,0xA2},    // -
+    {0x3BC8,0xBD},    // -
+    {0x3BCA,0xBD},    // -
+    {0x4004,0xC0},    // TXCLKESC_FREQ[15:0]
+    {0x4005,0x06},    //
+    {0x400C,0x00},    // INCKSEL6
+    {0x4018,0x67},    // TCLKPOST[15:0]
+    {0x401A,0x27},    // TCLKPREPARE[15:0]
+    {0x401C,0x27},    // TCLKTRAIL[15:0]
+    {0x401E,0xB7},    // TCLKZERO[15:0]
+    {0x401F,0x00},    //
+    {0x4020,0x2F},    // THSPREPARE[15:0]
+    {0x4022,0x4F},    // THSZERO[15:0]
+    {0x4024,0x2F},    // THSTRAIL[15:0]
+    {0x4026,0x47},    // THSEXIT[15:0]
+    {0x4028,0x27},    // TLPX[15:0]
+    {0x4074,0x01},    // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+//3096x2190 891Mbps, 10bits, Mclk 27M
+const static I2C_ARRAY Sensor_6m_30fps_init_table_4lane_linear[] =
+{
+    /*
+    IMX415-AAQR Window cropping 3096x2190 CSI-2_4lane 27MHz AD:10bit Output:10bit 891Mbps Master Mode 30fps Integration Time 33.217ms
+    Tool ver : Ver6.0  vts:2250 hts:1100
+    */
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3028, 0x4C},  // HMAX[15:0]
+    {0x3029, 0x04},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3032, 0x00},  // MDBIT
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3040, 0x80},  // PIX_HST[12:0]
+    {0x3041, 0x01},  //
+    {0x3043, 0x0C},  //
+    {0x3044, 0x00},  // PIX_VST[12:0]//02
+    {0x3045, 0x00},  //
+    {0x3046, 0x1C},  // PIX_VWIDTH[12:0]
+    {0x3050, 0x08},  // SHR0[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+//3096x1758@30fps
+const static I2C_ARRAY Sensor_5p3m_30fps_init_table_4lane_linear[] =
+{
+    /*
+    IMX415-AAQR Window cropping 3096x1758 CSI-2_4lane 27MHz AD:10bit Output:10bit 891Mbps Master Mode 30fps Integration Time 33.217ms
+    Tool ver : Ver6.0
+    */
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},     //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},     //delay (ms)
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3028, 0x4C},  // HMAX[15:0]
+    {0x3029, 0x04},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3032, 0x00},  // MDBIT
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3040, 0x80},  // PIX_HST[12:0]
+    {0x3041, 0x01},  //
+    {0x3043, 0x0C},  //
+    {0x3044, 0xB0},  // PIX_VST[12:0]  //01b2
+    {0x3045, 0x01},  //
+    {0x3046, 0xBC},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0D},  //
+    {0x3050, 0x08},  // SHR0[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+
+#if 0
+//5M25 594Mbps, 10bits, Mclk 27M
+const static I2C_ARRAY Sensor_5m_25fps_init_table_4lane_linear[] =
+{
+    /*
+    IMX415-AAQR Window cropping 2592x1944 CSI-2_4lane 27MHz AD:10bit Output:10bit 594Mbps Master Mode 25fps Integration Time 39.86ms
+    Tool ver : Ver6.0
+    */
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3028, 0x28},  // HMAX[15:0]
+    {0x3029, 0x05},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3032, 0x00},  // MDBIT
+    {0x3033, 0x07},  // SYS_MODE[3:0]
+    {0x3040, 0x7C},  // PIX_HST[12:0]
+    {0x3041, 0x02},  //
+    {0x3042, 0x20},  // PIX_HWIDTH[12:0]
+    {0x3043, 0x0A},  //
+    {0x3044, 0xF8},  // PIX_VST[12:0] //DA
+    {0x3045, 0x00},  //
+    {0x3046, 0x30},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0F},  //
+    {0x3050, 0x08},  // SHR0[19:0]
+    {0x30C0, 0x2A},  // XVSOUTSEL[1:0] XHSOUTSEL[3:2]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CC, 0x00},
+    {0x30CD, 0x00},
+    {0x30CF, 0x00},
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0x84},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x67},  // TCLKPOST[15:0]
+    {0x401A, 0x27},  // TCLKPREPARE[15:0]
+    {0x401C, 0x27},  // TCLKTRAIL[15:0]
+    {0x401E, 0xB7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x2F},  // THSPREPARE[15:0]
+    {0x4022, 0x4F},  // THSZERO[15:0]
+    {0x4024, 0x2F},  // THSTRAIL[15:0]
+    {0x4026, 0x47},  // THSEXIT[15:0]
+    {0x4028, 0x27},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+#endif
+//5M30 891Mbps, 10bits, Mclk 27M
+const static I2C_ARRAY Sensor_5m_30fps_init_table_4lane_linear[] =
+{
+    /*
+    IMX415-AAQR Window cropping 2616x1974 CSI-2_4lane 27MHz AD:10bit Output:10bit 891Mbps Master Mode 30fps Integration Time 33.217ms
+    Tool ver : Ver6.0
+    */
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3024, 0x60},  //VMAX LSB
+    {0x3025, 0x08},  //VMAX MSB     8CAh: 2250
+    {0x3026, 0x00},  //VMAX MSB [0:3]
+    {0x3028, 0x82},  // HMAX[15:0]
+    {0x3029, 0x04},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3032, 0x00},  // MDBIT
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3040, 0x70},  // PIX_HST[12:0]
+    {0x3041, 0x02},  //
+    {0x3042, 0x38},  // PIX_HWIDTH[12:0]
+    {0x3043, 0x0A},  //
+    {0x3044, 0xD8},  // PIX_VST[12:0] //DA
+    {0x3045, 0x00},  //
+    {0x3046, 0x6C},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0F},  //
+    {0x3050, 0x08},  // SHR0[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+//4p8M30 891Mbps, 10bits, Mclk 27M
+const static I2C_ARRAY Sensor_4p8m_30fps_init_table_4lane_linear[] =
+{
+    /*
+    IMX415-AAQR Window cropping 2976x1686 CSI-2_4lane 27MHz AD:10bit Output:10bit 891Mbps Master Mode 30fps Integration Time 33.217ms
+    Tool ver : Ver6.0
+    */
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3028, 0x4C},  // HMAX[15:0]
+    {0x3029, 0x04},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3032, 0x00},  // MDBIT
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3040, 0xBC},  // PIX_HST[12:0]
+    {0x3041, 0x01},  //
+    {0x3042, 0xA0},  // PIX_HWIDTH[12:0]
+    {0x3043, 0x0B},  //
+    {0x3044, 0xF8},  // PIX_VST[12:0] //FA
+    {0x3045, 0x01},  //
+    {0x3046, 0x2C},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0D},  //
+    {0x3050, 0x08},  // SHR0[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+//2592x1470@30fps
+const static I2C_ARRAY Sensor_3p6m_30fps_init_table_4lane_linear[] =
+{
+    /*
+    IMX415-AAQR Window cropping 2592x1470 CSI-2_4lane 27MHz AD:10bit Output:10bit 891Mbps Master Mode 30fps Integration Time 33.217ms
+    Tool ver : Ver6.0
+    */
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3028, 0x4C},  // HMAX[15:0]
+    {0x3029, 0x04},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3032, 0x00},  // MDBIT
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3040, 0x7C},  // PIX_HST[12:0]
+    {0x3041, 0x02},  //
+    {0x3042, 0x20},  // PIX_HWIDTH[12:0]
+    {0x3043, 0x0A},  //
+    {0x3044, 0xD0},  // PIX_VST[12:0] //D2
+    {0x3045, 0x02},  //
+    {0x3046, 0x7C},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0B},  //
+    {0x3050, 0x08},  // SHR0[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+//8M30 891Mbps, 10bits, Mclk 27M
+const static I2C_ARRAY Sensor_8m_30fps_init_table_4lane_linear[] =
+{
+    /*
+        IMX415-AAQRAll-pixel scan
+        CSI-2_4lane
+        27MHz
+        AD:10bit
+        Output:10bit
+        891Mbps
+        Master Mode 30fps
+        Integration Time33.217ms
+    */
+
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008,0x5D},    // BCWAIT_TIME[9:0]
+    {0x300A,0x42},    // CPWAIT_TIME[9:0]
+    {0x3024,0xCA},    // VMAX[19:0]
+    {0x3025,0x08},    //
+    {0x3028,0x4C},    // HMAX[15:0]
+    {0x3029,0x04},    //
+    {0x3031,0x00},    // ADBIT[1:0]
+    {0x3032,0x00},    // MDBIT
+    {0x3033,0x05},    // SYS_MODE[3:0]
+    {0x3050,0x08},    // SHR0[19:0]
+    {0x30C1,0x00},    // XVS_DRV[1:0]
+    {0x3116,0x23},    // INCKSEL2[7:0]
+    {0x3118,0xC6},    // INCKSEL3[10:0]
+    {0x311A,0xE7},    // INCKSEL4[10:0]
+    {0x311E,0x23},    // INCKSEL5[7:0]
+    {0x32D4,0x21},    // -
+    {0x32EC,0xA1},    // -
+    {0x3452,0x7F},    // -
+    {0x3453,0x03},    // -
+    {0x358A,0x04},    // -
+    {0x35A1,0x02},    // -
+    {0x36BC,0x0C},    // -
+    {0x36CC,0x53},    // -
+    {0x36CD,0x00},    // -
+    {0x36CE,0x3C},    // -
+    {0x36D0,0x8C},    // -
+    {0x36D1,0x00},    // -
+    {0x36D2,0x71},    // -
+    {0x36D4,0x3C},    // -
+    {0x36D6,0x53},    // -
+    {0x36D7,0x00},    // -
+    {0x36D8,0x71},    // -
+    {0x36DA,0x8C},    // -
+    {0x36DB,0x00},    // -
+    {0x3701,0x00},    // ADBIT1[7:0]
+    {0x3724,0x02},    // -
+    {0x3726,0x02},    // -
+    {0x3732,0x02},    // -
+    {0x3734,0x03},    // -
+    {0x3736,0x03},    // -
+    {0x3742,0x03},    // -
+    {0x3862,0xE0},    // -
+    {0x38CC,0x30},    // -
+    {0x38CD,0x2F},    // -
+    {0x395C,0x0C},    // -
+
+    {0x3A42,0xD1},    // -
+    {0x3A4C,0x77},    // -
+    {0x3AE0,0x02},    // -
+    {0x3AEC,0x0C},    // -
+    {0x3B00,0x2E},    // -
+    {0x3B06,0x29},    // -
+    {0x3B98,0x25},    // -
+    {0x3B99,0x21},    // -
+    {0x3B9B,0x13},    // -
+    {0x3B9C,0x13},    // -
+    {0x3B9D,0x13},    // -
+    {0x3B9E,0x13},    // -
+    {0x3BA1,0x00},    // -
+    {0x3BA2,0x06},    // -
+    {0x3BA3,0x0B},    // -
+    {0x3BA4,0x10},    // -
+    {0x3BA5,0x14},    // -
+    {0x3BA6,0x18},    // -
+    {0x3BA7,0x1A},    // -
+    {0x3BA8,0x1A},    // -
+    {0x3BA9,0x1A},    // -
+    {0x3BAC,0xED},    // -
+    {0x3BAD,0x01},    // -
+    {0x3BAE,0xF6},    // -
+    {0x3BAF,0x02},    // -
+    {0x3BB0,0xA2},    // -
+    {0x3BB1,0x03},    // -
+    {0x3BB2,0xE0},    // -
+    {0x3BB3,0x03},    // -
+    {0x3BB4,0xE0},    // -
+    {0x3BB5,0x03},    // -
+    {0x3BB6,0xE0},    // -
+    {0x3BB7,0x03},    // -
+    {0x3BB8,0xE0},    // -
+    {0x3BBA,0xE0},    // -
+    {0x3BBC,0xDA},    // -
+    {0x3BBE,0x88},    // -
+    {0x3BC0,0x44},    // -
+    {0x3BC2,0x7B},    // -
+    {0x3BC4,0xA2},    // -
+    {0x3BC8,0xBD},    // -
+    {0x3BCA,0xBD},    // -
+    {0x4004,0xC0},    // TXCLKESC_FREQ[15:0]
+    {0x4005,0x06},    //
+    {0x400C,0x00},    // INCKSEL6
+    {0x4018,0x7F},    // TCLKPOST[15:0]
+    {0x401A,0x37},    // TCLKPREPARE[15:0]
+    {0x401C,0x37},    // TCLKTRAIL[15:0]
+    {0x401E,0xF7},    // TCLKZERO[15:0]
+    {0x401F,0x00},    //
+    {0x4020,0x3F},    // THSPREPARE[15:0]
+    {0x4022,0x6F},    // THSZERO[15:0]
+    {0x4024,0x3F},    // THSTRAIL[15:0]
+    {0x4026,0x5F},    // THSEXIT[15:0]
+    {0x4028,0x2F},    // TLPX[15:0]
+    {0x4074,0x01},    // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+
+//1920x1080@60fps
+const static I2C_ARRAY Sensor_2m_60fps_init_table_4lane_linear[] =
+{
+/*
+IMX415-AAQR 2/2-line binning CSI-2_4lane 27MHz AD:10bit Output:12bit 891Mbps Master Mode 59.998fps Integration Time 16.61ms
+Tool ver : Ver6.0
+*/
+    {0x3000, 0x01},    //Standby
+    //{0xffff, 0x24},    //delay (ms)
+    {0x3002, 0x01},    //Master mode stop
+    //{0xffff, 0x10},    //delay (ms)
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x3020, 0x01},  // HADD
+    {0x3021, 0x01},  // VADD
+    {0x3022, 0x01},  // ADDMODE[1:0]
+    {0x3024, 0xF8},  // VMAX[19:0]
+    {0x3028, 0x1B},  // HMAX[15:0]
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3050, 0x08},  // SHR0[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30D9, 0x02},  // DIG_CLP_VSTART[4:0]
+    {0x30DA, 0x01},  // DIG_CLP_VNUM[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x24},
+    {0x3002, 0x00},    //Master mode start
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+};
+
+// 1280x720@120fps
+const static I2C_ARRAY Sensor_1m_120fps_init_table_4lane_linear[] =
+{
+/*
+IMX415-AAQR 2/2-line binning & Window cropping 2568x1440 CSI-2_4lane 24MHz AD:10bit Output:12bit 1440Mbps Master Mode 119.988fps Integration Time 8ms Gain:6dB
+Ver8.0
+*/
+    {0x3000, 0x01},  // Standby
+    {0x3002, 0x01},  // Master mode stop
+    {0x3008, 0x54},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x3B},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3020, 0x01},  // HADD
+    {0x3021, 0x01},  // VADD
+    {0x3022, 0x01},  // ADDMODE[1:0]
+    {0x3024, 0x6C},  // VMAX[19:0]
+    {0x3025, 0x06},  //
+    {0x3028, 0x6D},  // HMAX[15:0]
+    {0x3029, 0x01},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3033, 0x08},  // SYS_MODE[3:0]
+    {0x3040, 0x88},  // PIX_HST[12:0]
+    {0x3041, 0x02},  //
+    {0x3042, 0x08},  // PIX_HWIDTH[12:0]
+    {0x3043, 0x0A},  //
+    {0x3044, 0xF0},  // PIX_VST[12:0]
+    {0x3045, 0x02},  //
+    {0x3046, 0x40},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0B},  //
+    {0x3050, 0x42},  // SHR0[19:0]
+    {0x3090, 0x14},  // GAIN_PCG_0[8:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30D9, 0x02},  // DIG_CLP_VSTART[4:0]
+    {0x30DA, 0x01},  // DIG_CLP_VNUM[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xB4},  // INCKSEL3[10:0]
+    {0x311A, 0xFC},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x344C, 0x2B},  // -
+    {0x344D, 0x01},  // -
+    {0x344E, 0xED},  // -
+    {0x344F, 0x01},  // -
+    {0x3450, 0xF6},  // -
+    {0x3451, 0x02},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x35EC, 0x27},  // -
+    {0x35EE, 0x8D},  // -
+    {0x35F0, 0x8D},  // -
+    {0x35F2, 0x29},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3720, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x39A4, 0x07},  // -
+    {0x39A8, 0x32},  // -
+    {0x39AA, 0x32},  // -
+    {0x39AC, 0x32},  // -
+    {0x39AE, 0x32},  // -
+    {0x39B0, 0x32},  // -
+    {0x39B2, 0x2F},  // -
+    {0x39B4, 0x2D},  // -
+    {0x39B6, 0x28},  // -
+    {0x39B8, 0x30},  // -
+    {0x39BA, 0x30},  // -
+    {0x39BC, 0x30},  // -
+    {0x39BE, 0x30},  // -
+    {0x39C0, 0x30},  // -
+    {0x39C2, 0x2E},  // -
+    {0x39C4, 0x2B},  // -
+    {0x39C6, 0x25},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0x00},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x4018, 0x9F},  // TCLKPOST[15:0]
+    {0x401A, 0x57},  // TCLKPREPARE[15:0]
+    {0x401C, 0x57},  // TCLKTRAIL[15:0]
+    {0x401E, 0x87},  // TCLKZERO[15:0]
+    {0x4020, 0x5F},  // THSPREPARE[15:0]
+    {0x4022, 0xA7},  // THSZERO[15:0]
+    {0x4024, 0x5F},  // THSTRAIL[15:0]
+    {0x4026, 0x97},  // THSEXIT[15:0]
+    {0x4028, 0x4F},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},  // Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},  // Master mode start
+    {0x3260, 0x00},  // Gain_Pgc_Fidmd
+};
+
+#if 0
+// 1280x720@135fps
+const static I2C_ARRAY Sensor_1m_135fps_init_table_4lane_linear[] =
+{
+/*
+IMX415-AAQR 2/2-line binning & Window cropping 2568x1440 CSI-2_4lane 37.125Mhz AD:10bit Output:12bit 1485Mbps Master Mode 134.987fps Integration Time 0.999ms Gain:6dB
+Ver8.0
+*/
+    {0x3000, 0x01},  // Standby
+    {0x3002, 0x01},  // Master mode stop
+    {0x3008, 0x7F},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x5B},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  // WINMODE[3:0]
+    {0x3020, 0x01},  // HADD
+    {0x3021, 0x01},  // VADD
+    {0x3022, 0x01},  // ADDMODE[1:0]
+    {0x3024, 0xE3},  // VMAX[19:0]
+    {0x3025, 0x05},  //
+    {0x3028, 0x6D},  // HMAX[15:0]
+    {0x3029, 0x01},  //
+    {0x3031, 0x00},  // ADBIT[1:0]
+    {0x3033, 0x08},  // SYS_MODE[3:0]
+    {0x3040, 0x88},  // PIX_HST[12:0]
+    {0x3041, 0x02},  //
+    {0x3042, 0x08},  // PIX_HWIDTH[12:0]
+    {0x3043, 0x0A},  //
+    {0x3044, 0xF0},  // PIX_VST[12:0]
+    {0x3045, 0x02},  //
+    {0x3046, 0x40},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0B},  //
+    {0x3050, 0x18},  // SHR0[19:0]
+    {0x3051, 0x05},  //
+    {0x3090, 0x14},  // GAIN_PCG_0[8:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30D9, 0x02},  // DIG_CLP_VSTART[4:0]
+    {0x30DA, 0x01},  // DIG_CLP_VNUM[1:0]
+    {0x3116, 0x24},  // INCKSEL2[7:0]
+    {0x3118, 0xA0},  // INCKSEL3[10:0]
+    {0x311E, 0x24},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x344C, 0x2B},  // -
+    {0x344D, 0x01},  // -
+    {0x344E, 0xED},  // -
+    {0x344F, 0x01},  // -
+    {0x3450, 0xF6},  // -
+    {0x3451, 0x02},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x35EC, 0x27},  // -
+    {0x35EE, 0x8D},  // -
+    {0x35F0, 0x8D},  // -
+    {0x35F2, 0x29},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // ADBIT1[7:0]
+    {0x3720, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x39A4, 0x07},  // -
+    {0x39A8, 0x32},  // -
+    {0x39AA, 0x32},  // -
+    {0x39AC, 0x32},  // -
+    {0x39AE, 0x32},  // -
+    {0x39B0, 0x32},  // -
+    {0x39B2, 0x2F},  // -
+    {0x39B4, 0x2D},  // -
+    {0x39B6, 0x28},  // -
+    {0x39B8, 0x30},  // -
+    {0x39BA, 0x30},  // -
+    {0x39BC, 0x30},  // -
+    {0x39BE, 0x30},  // -
+    {0x39C0, 0x30},  // -
+    {0x39C2, 0x2E},  // -
+    {0x39C4, 0x2B},  // -
+    {0x39C6, 0x25},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0x48},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x09},  //
+    {0x4018, 0xA7},  // TCLKPOST[15:0]
+    {0x401A, 0x57},  // TCLKPREPARE[15:0]
+    {0x401C, 0x5F},  // TCLKTRAIL[15:0]
+    {0x401E, 0x97},  // TCLKZERO[15:0]
+    {0x4020, 0x5F},  // THSPREPARE[15:0]
+    {0x4022, 0xAF},  // THSZERO[15:0]
+    {0x4024, 0x5F},  // THSTRAIL[15:0]
+    {0x4026, 0x9F},  // THSEXIT[15:0]
+    {0x4028, 0x4F},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},  // Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},  // Master mode start
+    {0x3260, 0x00},  // Gain_Pgc_Fidmd
+};
+#endif
+
+const static I2C_ARRAY Sensor_init_table_4lane_HDR_DOL[] =
+{
+    /*
+    IMX415-AAQR All-pixel scan CSI-2_4lane 27MHz AD:12bit Output:12bit 891Mbps Master Mode DOL HDR 2frame VC 15fps Integration Time LEF:9.988ms SEF:0.121ms
+    Tool ver : Ver6.0  vts:2250 hts:1100
+    */
+    {0x3000, 0x01},    //Standby
+    {0x3002, 0x01},    //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x3028, 0x4C},  // HMAX[15:0]
+    {0x3029, 0x04},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3050, 0xF2},  // SHR0[19:0]
+    {0x3051, 0x0E},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x11},  // RHS1[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},    //Master mode start
+    {0x3260, 0x00},    //Gain_Pgc_Fidmd
+};
+
+const static I2C_ARRAY Sensor_8m_20fps_init_table_4lane_HDR_DOL[] =
+{
+    /*
+        IMX415-AAQRAll-pixel scan
+        CSI-2_4lane
+        27MHz
+        AD:10bit Output:10bit
+        1485Mbps
+        Master Mode DOL HDR 2frame VC
+        20.002fps
+        Integration Time LEF:1.002ms SEF:0.118ms
+    */
+    {0x3000, 0x01},    //Standby
+    {0x3002, 0x01},    //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x3024, 0x7A},  // VMAX[15:0]
+    {0x3025, 0x0D},  //
+    {0x3028, 0x1A},  // HMAX[15:0]
+    {0x3029, 0x02},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3031, 0x00},  //
+    {0x3032, 0x00},  //
+    {0x3033, 0x08},  // SYS_MODE[3:0]
+    {0x3050, 0x6A},  // SHR0[19:0]
+    {0x3051, 0x1A},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x19},  // RHS1[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xA5},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x4018, 0xA7},  // TCLKPOST[15:0]
+    {0x401A, 0x57},  // TCLKPREPARE[15:0]
+    {0x401C, 0x5F},  // TCLKTRAIL[15:0]
+    {0x401E, 0x97},  // TCLKZERO[15:0]
+    {0x4020, 0x5F},  // THSPREPARE[15:0]
+    {0x4022, 0xAF},  // THSZERO[15:0]
+    {0x4024, 0x5F},  // THSTRAIL[15:0]
+    {0x4026, 0x9F},  // THSEXIT[15:0]
+    {0x4028, 0x4F},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},    //Master mode start
+    {0x3260, 0x00},    //Gain_Pgc_Fidmd
+};
+
+const static I2C_ARRAY Sensor_8m_30fps_init_table_4lane_HDR_DOL[] =
+{
+    /*
+        IMX415-AAQRAll-pixel scan
+        CSI-2_4lane
+        27MHz
+        AD:10bit Output:10bit
+        1485Mbps
+        Master Mode DOL HDR 2frame VC
+        30.002fps
+        Integration Time LEF:1.002ms SEF:0.118ms
+    */
+    {0x3000, 0x01},    //Standby
+    {0x3002, 0x01},    //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x3024, 0xFC},  // VMAX[15:0]
+    {0x3025, 0x08},  //
+    {0x3028, 0x1A},  // HMAX[15:0]
+    {0x3029, 0x02},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3031, 0x00},  //
+    {0x3032, 0x00},  //
+    {0x3033, 0x08},  // SYS_MODE[3:0]
+    {0x3050, 0x6E},  // SHR0[19:0]
+    {0x3051, 0x11},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x19},  // RHS1[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xA5},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x4018, 0xA7},  // TCLKPOST[15:0]
+    {0x401A, 0x57},  // TCLKPREPARE[15:0]
+    {0x401C, 0x5F},  // TCLKTRAIL[15:0]
+    {0x401E, 0x97},  // TCLKZERO[15:0]
+    {0x4020, 0x5F},  // THSPREPARE[15:0]
+    {0x4022, 0xAF},  // THSZERO[15:0]
+    {0x4024, 0x5F},  // THSTRAIL[15:0]
+    {0x4026, 0x9F},  // THSEXIT[15:0]
+    {0x4028, 0x4F},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},    //Master mode start
+    {0x3260, 0x00},    //Gain_Pgc_Fidmd
+};
+
+const static I2C_ARRAY Sensor_5m_30fps_init_table_4lane_HDR_DOL[] =
+{
+    /*
+        IMX415-AAQR
+        Window cropping2592x1944
+        CSI-2_4lane27MHz
+        AD:10bit Output:10bit
+        1485Mbps
+        Master Mode DOL HDR 2frame VC
+        30.002fps
+        Integration Time LEF:1.002ms SEF:0.118ms
+
+    */
+    {0x3000, 0x01},    //Standby
+    {0x3002, 0x01},    //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  //
+    {0x3024, 0xFC},  // VMAX[15:0]
+    {0x3025, 0x08},  //
+    {0x3028, 0x1A},  // HMAX[15:0]
+    {0x3029, 0x02},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3031, 0x00},  //
+    {0x3032, 0x00},  //
+    {0x3033, 0x08},  // SYS_MODE[3:0]
+    {0x3040, 0x7C},  //
+    {0x3041, 0x02},  //
+    {0x3042, 0x20},  //
+    {0x3043, 0x0A},  //
+    {0x3044, 0xF8},  //
+    {0x3045, 0x00},  //
+    {0x3046, 0x30},  //
+    {0x3047, 0x0F},  //
+    {0x3050, 0x6E},  // SHR0[19:0]
+    {0x3051, 0x11},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x19},  // RHS1[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xA5},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x4018, 0xA7},  // TCLKPOST[15:0]
+    {0x401A, 0x57},  // TCLKPREPARE[15:0]
+    {0x401C, 0x5F},  // TCLKTRAIL[15:0]
+    {0x401E, 0x97},  // TCLKZERO[15:0]
+    {0x4020, 0x5F},  // THSPREPARE[15:0]
+    {0x4022, 0xAF},  // THSZERO[15:0]
+    {0x4024, 0x5F},  // THSTRAIL[15:0]
+    {0x4026, 0x9F},  // THSEXIT[15:0]
+    {0x4028, 0x4F},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},    //Master mode start
+    {0x3260, 0x00},    //Gain_Pgc_Fidmd
+};
+
+#if 0
+const static I2C_ARRAY Sensor_5m_15fps_init_table_4lane_HDR_DOL[] =
+{
+    /*
+    IMX415-AAQR window cropping2616x1974 scan CSI-2_4lane 27MHz AD:12bit Output:12bit 891Mbps Master Mode DOL HDR 2frame VC 15fps Integration Time LEF:9.988ms SEF:0.121ms
+    Tool ver : Ver6.0
+    */
+    {0x3000, 0x01},    //Standby
+    {0x3002, 0x01},    //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04}, // WINMODE[3:0]
+    {0x3028, 0x4C},  // HMAX[15:0]
+    {0x3029, 0x04},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3040, 0x70},  // PIX_HST[12:0]
+    {0x3041, 0x02},  //
+    {0x3042, 0x38},  // PIX_HWIDTH[12:0]
+    {0x3043, 0x0A},  //
+    {0x3044, 0xDA},  // PIX_VST[12:0]
+    {0x3045, 0x00},  //
+    {0x3046, 0x6C},  // PIX_VWIDTH[12:0]
+    {0x3047, 0x0F},  //
+    {0x3050, 0xF2},  // SHR0[19:0]
+    {0x3051, 0x0E},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x11},  // RHS1[19:0]
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},  // INCKSEL6
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},  //
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // INCKSEL7 [2:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},    //Master mode start
+    {0x3260, 0x00},    //Gain_Pgc_Fidmd
+};
+#endif
+
+const static I2C_ARRAY Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[] =
+{
+    /*
+    "IMX415-AAQR Window cropping 2976x1686 CSI-2_4lane 27MHz
+     AD:10bit Output:10bit 1485Mbps
+     Master Mode DOL HDR 2frame VC 30.002fps
+     Integration Time LEF:1.002ms SEF:0.118ms"
+    */
+    {0x3000, 0x01},  //Standby
+    {0x3002, 0x01},  //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  //
+    {0x3024, 0xFC},  // VMAX[15:0] FC
+    {0x3025, 0x08},  //
+    {0x3028, 0x1A},  // HMAX[15:0] 1A
+    {0x3029, 0x02},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3031, 0x00},  //
+    {0x3032, 0x00},  //
+    {0x3033, 0x08},  // SYS_MODE[3:0]
+    {0x3040, 0xBC},  //
+    {0x3041, 0x01},  //            01
+    {0x3042, 0xA0},  //
+    {0x3043, 0x0B},  //
+    {0x3044, 0xF8},  //
+    {0x3045, 0x01},  //            01
+    {0x3046, 0x30},  //
+    {0x3047, 0x0D},  //
+    {0x3050, 0x6E},  // SHR0[19:0]
+    {0x3051, 0x11},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x19},  // RHS1[19:0]
+    {0x30C0, 0x2A},
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CC, 0x00},
+    {0x30CD, 0x00},
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xA5},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x4018, 0xA7},  // TCLKPOST[15:0]
+    {0x401A, 0x57},  // TCLKPREPARE[15:0]
+    {0x401C, 0x5F},  // TCLKTRAIL[15:0]
+    {0x401E, 0x97},  // TCLKZERO[15:0]
+    {0x4020, 0x5F},  // THSPREPARE[15:0]
+    {0x4022, 0xAF},  // THSZERO[15:0]
+    {0x4024, 0x5F},  // THSTRAIL[15:0]
+    {0x4026, 0x9F},  // THSEXIT[15:0]
+    {0x4028, 0x4F},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},  //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},  //Master mode start
+    {0x3260, 0x00},  //Gain_Pgc_Fidmd
+};
+
+const static I2C_ARRAY Sensor_4m_30fps_init_table_4lane_HDR_DOL[] =
+{
+    /*
+        "IMX415-AAQR Window cropping 2688x1520
+        CSI-2_4lane 27MHz AD:10bit Output:10bit 1485Mbps
+        Master Mode DOL HDR 2frame VC
+        30.002fps Integration Time LEF:1.002ms SEF:0.118ms"
+    */
+    {0x3000, 0x01},  //Standby
+    {0x3002, 0x01},  //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+    {0x301C, 0x04},  //
+    {0x3024, 0xFC},  // VMAX[15:0]
+    {0x3025, 0x08},  //
+    {0x3028, 0x1A},  // HMAX[15:0]
+    {0x3029, 0x02},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3031, 0x00},  //
+    {0x3032, 0x00},  //
+    {0x3033, 0x08},  // SYS_MODE[3:0]
+    {0x3040, 0x4C},  //
+    {0x3041, 0x01},  //
+    {0x3042, 0x80},  //
+    {0x3043, 0x0A},  //
+    {0x3044, 0xA0},  //
+    {0x3045, 0x01},  //
+    {0x3046, 0xE0},  //
+    {0x3047, 0x0B},  //
+    {0x3050, 0x6E},  // SHR0[19:0]
+    {0x3051, 0x11},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x19},  // RHS1[19:0]
+    {0x30C0, 0x2A},
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CC, 0x00},
+    {0x30CD, 0x00},
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xA5},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // -
+    {0x32EC, 0xA1},  // -
+    {0x3452, 0x7F},  // -
+    {0x3453, 0x03},  // -
+    {0x358A, 0x04},  // -
+    {0x35A1, 0x02},  // -
+    {0x36BC, 0x0C},  // -
+    {0x36CC, 0x53},  // -
+    {0x36CD, 0x00},  // -
+    {0x36CE, 0x3C},  // -
+    {0x36D0, 0x8C},  // -
+    {0x36D1, 0x00},  // -
+    {0x36D2, 0x71},  // -
+    {0x36D4, 0x3C},  // -
+    {0x36D6, 0x53},  // -
+    {0x36D7, 0x00},  // -
+    {0x36D8, 0x71},  // -
+    {0x36DA, 0x8C},  // -
+    {0x36DB, 0x00},  // -
+    {0x3701, 0x00},  // -
+    {0x3724, 0x02},  // -
+    {0x3726, 0x02},  // -
+    {0x3732, 0x02},  // -
+    {0x3734, 0x03},  // -
+    {0x3736, 0x03},  // -
+    {0x3742, 0x03},  // -
+    {0x3862, 0xE0},  // -
+    {0x38CC, 0x30},  // -
+    {0x38CD, 0x2F},  // -
+    {0x395C, 0x0C},  // -
+    {0x3A42, 0xD1},  // -
+    {0x3A4C, 0x77},  // -
+    {0x3AE0, 0x02},  // -
+    {0x3AEC, 0x0C},  // -
+    {0x3B00, 0x2E},  // -
+    {0x3B06, 0x29},  // -
+    {0x3B98, 0x25},  // -
+    {0x3B99, 0x21},  // -
+    {0x3B9B, 0x13},  // -
+    {0x3B9C, 0x13},  // -
+    {0x3B9D, 0x13},  // -
+    {0x3B9E, 0x13},  // -
+    {0x3BA1, 0x00},  // -
+    {0x3BA2, 0x06},  // -
+    {0x3BA3, 0x0B},  // -
+    {0x3BA4, 0x10},  // -
+    {0x3BA5, 0x14},  // -
+    {0x3BA6, 0x18},  // -
+    {0x3BA7, 0x1A},  // -
+    {0x3BA8, 0x1A},  // -
+    {0x3BA9, 0x1A},  // -
+    {0x3BAC, 0xED},  // -
+    {0x3BAD, 0x01},  // -
+    {0x3BAE, 0xF6},  // -
+    {0x3BAF, 0x02},  // -
+    {0x3BB0, 0xA2},  // -
+    {0x3BB1, 0x03},  // -
+    {0x3BB2, 0xE0},  // -
+    {0x3BB3, 0x03},  // -
+    {0x3BB4, 0xE0},  // -
+    {0x3BB5, 0x03},  // -
+    {0x3BB6, 0xE0},  // -
+    {0x3BB7, 0x03},  // -
+    {0x3BB8, 0xE0},  // -
+    {0x3BBA, 0xE0},  // -
+    {0x3BBC, 0xDA},  // -
+    {0x3BBE, 0x88},  // -
+    {0x3BC0, 0x44},  // -
+    {0x3BC2, 0x7B},  // -
+    {0x3BC4, 0xA2},  // -
+    {0x3BC8, 0xBD},  // -
+    {0x3BCA, 0xBD},  // -
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x4018, 0xA7},  // TCLKPOST[15:0]
+    {0x401A, 0x57},  // TCLKPREPARE[15:0]
+    {0x401C, 0x5F},  // TCLKTRAIL[15:0]
+    {0x401E, 0x97},  // TCLKZERO[15:0]
+    {0x4020, 0x5F},  // THSPREPARE[15:0]
+    {0x4022, 0xAF},  // THSZERO[15:0]
+    {0x4024, 0x5F},  // THSTRAIL[15:0]
+    {0x4026, 0x9F},  // THSEXIT[15:0]
+    {0x4028, 0x4F},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},    //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},    //Master mode start
+    {0x3260, 0x00},    //Gain_Pgc_Fidmd
+};
+
+const static I2C_ARRAY Sensor_2m_30fps_init_table_4lane_HDR_DOL[] =
+{
+    /*
+    "IMX415-AAQR 2/2-line binning CSI-2_4lane 27MHz
+     AD:10bit Output:12bit 891Mbps
+     Master Mode DOL HDR 2frame VC
+     29.999fps Integration Time LEF:1.004ms SEF:0.118ms"
+    */
+    {0x3000, 0x01},  //Standby
+    {0x3002, 0x01},  //Master mode stop
+    {0x3008, 0x5D},  // BCWAIT_TIME[9:0]
+    {0x300A, 0x42},  // CPWAIT_TIME[9:0]
+
+    {0x3020, 0x01},  // 01h: Horizontal 2 binning
+    {0x3021, 0x01},  // 01h: Vertical 2 binning
+    {0x3022, 0x01},  // 01h: Horizontal/Vertical 2x2-line binning(RGB only)
+    {0x3024, 0xF8},  // MAX[15:0]
+    {0x3025, 0x08},  //
+    {0x3028, 0x1B},  // HMAX[15:0]
+    {0x3029, 0x02},  //
+    {0x302C, 0x01},  // WDMODE[1:0]
+    {0x302D, 0x01},  // WDSEL[1:0]
+    {0x3031, 0x00},  //
+    {0x3033, 0x05},  // SYS_MODE[3:0]
+    {0x3050, 0x66},  // SHR0[19:0]
+    {0x3051, 0x11},  //
+    {0x3054, 0x09},  // SHR1[19:0]
+    {0x3060, 0x19},  // RHS1[19:0]
+    {0x30C0, 0x2A},
+    {0x30C1, 0x00},  // XVS_DRV[1:0]
+    {0x30CC, 0x00},
+    {0x30CD, 0x00},
+    {0x30CF, 0x01},  // XVSMSKCNT_INT[1:0]
+    {0x30D9, 0x02},
+    {0x30DA, 0x01},
+    {0x3116, 0x23},  // INCKSEL2[7:0]
+    {0x3118, 0xC6},  // INCKSEL3[10:0]
+    {0x311A, 0xE7},  // INCKSEL4[10:0]
+    {0x311E, 0x23},  // INCKSEL5[7:0]
+    {0x32D4, 0x21},  // --
+    {0x32EC, 0xA1},  // --
+    {0x3452, 0x7F},  // --
+    {0x3453, 0x03},  // --
+    {0x358A, 0x04},  // --
+    {0x35A1, 0x02},  // --
+    {0x36BC, 0x0C},  // --
+    {0x36CC, 0x53},  // --
+    {0x36CD, 0x00},  // --
+    {0x36CE, 0x3C},  // --
+    {0x36D0, 0x8C},  // --
+    {0x36D1, 0x00},  // --
+    {0x36D2, 0x71},  // --
+    {0x36D4, 0x3C},  // --
+    {0x36D6, 0x53},  // --
+    {0x36D7, 0x00},  // --
+    {0x36D8, 0x71},  // --
+    {0x36DA, 0x8C},  // --
+    {0x36DB, 0x00},  // --
+    {0x3701, 0x00},  // --
+    {0x3724, 0x02},  // --
+    {0x3726, 0x02},  // --
+    {0x3732, 0x02},  // --
+    {0x3734, 0x03},  // --
+    {0x3736, 0x03},  // --
+    {0x3742, 0x03},  // --
+    {0x3862, 0xE0},  // --
+    {0x38CC, 0x30},  // --
+    {0x38CD, 0x2F},  // --
+    {0x395C, 0x0C},  // --
+    {0x3A42, 0xD1},  // --
+    {0x3A4C, 0x77},  // --
+    {0x3AE0, 0x02},  // --
+    {0x3AEC, 0x0C},  // --
+    {0x3B00, 0x2E},  // --
+    {0x3B06, 0x29},  // --
+    {0x3B98, 0x25},  // --
+    {0x3B99, 0x21},  // --
+    {0x3B9B, 0x13},  // --
+    {0x3B9C, 0x13},  // --
+    {0x3B9D, 0x13},  // --
+    {0x3B9E, 0x13},  // --
+    {0x3BA1, 0x00},  // --
+    {0x3BA2, 0x06},  // --
+    {0x3BA3, 0x0B},  // --
+    {0x3BA4, 0x10},  // --
+    {0x3BA5, 0x14},  // --
+    {0x3BA6, 0x18},  // --
+    {0x3BA7, 0x1A},  // --
+    {0x3BA8, 0x1A},  // --
+    {0x3BA9, 0x1A},  // --
+    {0x3BAC, 0xED},  // --
+    {0x3BAD, 0x01},  // --
+    {0x3BAE, 0xF6},  // --
+    {0x3BAF, 0x02},  // --
+    {0x3BB0, 0xA2},  // --
+    {0x3BB1, 0x03},  // --
+    {0x3BB2, 0xE0},  // --
+    {0x3BB3, 0x03},  // --
+    {0x3BB4, 0xE0},  // --
+    {0x3BB5, 0x03},  // --
+    {0x3BB6, 0xE0},  // --
+    {0x3BB7, 0x03},  // --
+    {0x3BB8, 0xE0},  // --
+    {0x3BBA, 0xE0},  // --
+    {0x3BBC, 0xDA},  // --
+    {0x3BBE, 0x88},  // --
+    {0x3BC0, 0x44},  // --
+    {0x3BC2, 0x7B},  // --
+    {0x3BC4, 0xA2},  // --
+    {0x3BC8, 0xBD},  // --
+    {0x3BCA, 0xBD},  // --
+    {0x4004, 0xC0},  // TXCLKESC_FREQ[15:0]
+    {0x4005, 0x06},  //
+    {0x400C, 0x00},
+    {0x4018, 0x7F},  // TCLKPOST[15:0]
+    {0x401A, 0x37},  // TCLKPREPARE[15:0]
+    {0x401C, 0x37},  // TCLKTRAIL[15:0]
+    {0x401E, 0xF7},  // TCLKZERO[15:0]
+    {0x401F, 0x00},
+    {0x4020, 0x3F},  // THSPREPARE[15:0]
+    {0x4022, 0x6F},  // THSZERO[15:0]
+    {0x4024, 0x3F},  // THSTRAIL[15:0]
+    {0x4026, 0x5F},  // THSEXIT[15:0]
+    {0x4028, 0x2F},  // TLPX[15:0]
+    {0x4074, 0x01},  // TLPX[15:0]
+    {0xffff, 0x10},
+    {0x3000, 0x00},  //Operating
+    {0xffff, 0x10},
+    {0x3002, 0x00},  //Master mode start
+    {0x3260, 0x00},  //Gain_Pgc_Fidmd
+};
+
+const static I2C_ARRAY Sensor_id_table[] = {
+    {0x3F12, 0x14},      // {address of ID, ID },
+    {0x3F13, 0x75},      // {address of ID, ID },
+};
+
+static I2C_ARRAY PatternTbl[] = {
+    {0x0000,0x00},       // colorbar pattern , bit 0 to enable
+};
+
+const static I2C_ARRAY expo_reg[] = {      // SHS0 (For Linear)
+    {0x3052, 0x00},
+    {0x3051, 0x00},
+    {0x3050, 0x08},
+};
+
+const static I2C_ARRAY expo_SHR0_reg[] = { // SHS0 (For LEF)
+    {0x3052, 0x00},
+    {0x3051, 0x16},
+    {0x3050, 0x22},
+};
+
+const static I2C_ARRAY expo_SHR1_reg[] = { // SHS1 (For SEF)
+    //decreasing exposure ratio version.
+    {0x3056, 0x00},
+    {0x3055, 0x00},
+    {0x3054, 0x09},
+};
+
+const static I2C_ARRAY vts_reg[] = {       //VMAX
+    {0x3026, 0x00}, //bit0-3-->MSB
+    {0x3025, 0x08},
+    {0x3024, 0xCA},
+};
+
+const static I2C_ARRAY vts_reg_hdr[] = {
+    {0x3026, 0x00}, //bit0-3-->MSB
+    {0x3025, 0x0B},
+    {0x3024, 0x3B},
+};
+
+const I2C_ARRAY expo_RHS1_reg[] = {
+    //decreasing exposure ratio version.
+    {0x3062, 0x00},
+    {0x3061, 0x00},
+    {0x3060, 0x11},
+};
+
+const static I2C_ARRAY gain_reg[] = {
+    {0x3090, 0x2A},//low bit
+    {0x3091, 0x00},//hcg mode,bit 4
+};
+
+const static I2C_ARRAY gain_HDR_DOL_LEF_reg[] = {
+    {0x3090, 0x2A},
+    {0x3091, 0x00},
+};
+
+const static I2C_ARRAY gain_HDR_DOL_SEF_reg[] = {
+    {0x3092, 0x20},
+    {0x3093, 0x00},
+};
+
+//static int g_sensor_ae_min_gain = 1024;
+static CUS_GAIN_GAP_ARRAY gain_gap_compensate[16] = {  //compensate  gain gap
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0},
+    {0, 0}
+};
+
+/////////////////////////////////////////////////////////////////
+//       @@@@@@@                                               //
+//           @@                                                //
+//          @@                                                 //
+//          @@@                                                //
+//       @   @@                                                //
+//        @@@@                                                 //
+//                                                             //
+//      Step 3 --  complete camera features                    //
+//                                                             //
+//  camera set EV, MWB, orientation, contrast, sharpness       //
+//   , saturation, and Denoise can work correctly.             //
+//                                                             //
+/////////////////////////////////////////////////////////////////
+
+#if 0
+static CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////////////// I2C function definition ///////////////////
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+/////////////////// sensor hardware dependent ///////////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+
+static int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+/*******I5/I6 Support MCLK List*******
+ *    CUS_CMU_CLK_27MHZ,
+ *    CUS_CMU_CLK_21P6MHZ,
+ *    CUS_CMU_CLK_12MHZ,
+ *    CUS_CMU_CLK_5P4MHZ,
+ *    CUS_CMU_CLK_36MHZ,
+ *    CUS_CMU_CLK_54MHZ,
+ *    CUS_CMU_CLK_43P2MHZ,
+ *    CUS_CMU_CLK_61P7MHZ,
+ *    CUS_CMU_CLK_72MHZ,
+ *    CUS_CMU_CLK_48MHZ,
+ *    CUS_CMU_CLK_24MHZ,
+ *    CUS_CMU_CLK_37P125MHZ,
+ ******End of Support MCLK List*******/
+#if 0
+static CUS_MCLK_FREQ UseParaMclk(const char *mclk)
+{
+    if (strcmp(mclk, "27M") == 0) {
+        return CUS_CMU_CLK_27MHZ;
+    } else if (strcmp(mclk, "12M") == 0) {
+        return CUS_CMU_CLK_12MHZ;
+    } else if (strcmp(mclk, "36M") == 0) {
+        return CUS_CMU_CLK_36MHZ;
+    } else if (strcmp(mclk, "48M") == 0) {
+        return CUS_CMU_CLK_48MHZ;
+    } else if (strcmp(mclk, "54M") == 0) {
+        return CUS_CMU_CLK_54MHZ;
+    } else if (strcmp(mclk, "24M") == 0) {
+        return CUS_CMU_CLK_24MHZ;
+    } else if (strcmp(mclk, "37.125M") == 0) {
+        return CUS_CMU_CLK_37P125MHZ;
+    }
+    return Preview_MCLK_SPEED;
+}
+#endif
+
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    //Sensor power on sequence
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);   // Powerdn Pull Low
+    sensor_if->Reset(idx, handle->reset_POLARITY);     // Rst Pull Low
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, ENABLE);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 1);
+    }
+
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    //Sensor board PWDN Enable, 1.8V & 2.9V need 30ms then Pull High
+    SENSOR_MSLEEP(31);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_UDELAY(1);
+    sensor_if->MCLK(idx, 1, handle->mclk);
+    SENSOR_DMSG("Sensor Power On finished\n");
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);   // Powerdn Pull Low
+    sensor_if->Reset(idx, handle->reset_POLARITY);     // Rst Pull Low
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_SONY_DOL) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 0);
+    }
+
+    handle->orient = SENSOR_ORIT;
+
+    return SUCCESS;
+}
+
+/////////////////// Check Sensor Product ID /////////////////////////
+static int pCus_CheckSensorProductID(ms_cus_sensor *handle)
+{
+    u16 sen_id_msb, sen_id_lsb;
+
+    /* Read Product ID */
+    SensorReg_Read(0x3f12, (void*)&sen_id_lsb);
+    SensorReg_Read(0x3f13, (void*)&sen_id_msb);//CHIP_ID_r3F13
+#if 0
+    if (sen_data != CHIP_ID) {
+        printk("[***ERROR***]Check Product ID Fail: 0x%x\n", sen_data);
+        return FAIL;
+    }
+#endif
+    return SUCCESS;
+}
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8)
+        table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>3)
+          return FAIL;
+
+      if(SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+          break;
+      else
+          SENSOR_MSLEEP(1);
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+       if( id_from_sensor[i].data != Sensor_id_table[i].data ){
+            SENSOR_DMSG("[%s] Please Check IMX415 Sensor Insert!!\n", __FUNCTION__);
+            return FAIL;
+       }
+       *id = id_from_sensor[i].data;
+    }
+
+    SENSOR_DMSG("[%s]IMX415 sensor ,Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    return SUCCESS;
+}
+
+static int imx415_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+    int i;
+    switch(mode)
+    {
+    case 1:
+        PatternTbl[0].data = 0x21; //enable
+        break;
+    case 0:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+    default:
+        PatternTbl[0].data &= 0xFE; //disable
+        break;
+    }
+    for(i=0;i< ARRAY_SIZE(PatternTbl);i++)
+    {
+        if(SensorReg_Write(PatternTbl[i].reg,PatternTbl[i].data) != SUCCESS)
+        {
+            SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+            return FAIL;
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_linear);i++)
+    {
+        if(Sensor_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_8m_20fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_8m_20fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_8m_20fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_8m_20fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_8m_20fps_init_table_4lane_linear[i].reg, Sensor_8m_20fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_8m_20fps_init_table_4lane_linear[i].reg, Sensor_8m_20fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_8m_20fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_8m_20fps_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_8m_20fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_8m_20fps_init_table_4lane_linear[i].reg, Sensor_8m_20fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+static int pCus_init_6m_30fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_6m_30fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_6m_30fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_6m_30fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_6m_30fps_init_table_4lane_linear[i].reg, Sensor_6m_30fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_6m_30fps_init_table_4lane_linear[i].reg, Sensor_6m_30fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_6m_30fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_6m_30fps_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_6m_30fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_6m_30fps_init_table_4lane_linear[i].reg, Sensor_6m_30fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_5p3m_30fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_5p3m_30fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_5p3m_30fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_5p3m_30fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_5p3m_30fps_init_table_4lane_linear[i].reg, Sensor_5p3m_30fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_5p3m_30fps_init_table_4lane_linear[i].reg, Sensor_5p3m_30fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_5p3m_30fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_8m20_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_5p3m_30fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_5p3m_30fps_init_table_4lane_linear[i].reg, Sensor_5p3m_30fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_init_5m_25fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_5m_25fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_5m_25fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_5m_25fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_5m_25fps_init_table_4lane_linear[i].reg, Sensor_5m_25fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_5m_25fps_init_table_4lane_linear[i].reg, Sensor_5m_25fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_5m_25fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_5m_25fps_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_5m_25fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_5m_25fps_init_table_4lane_linear[i].reg, Sensor_5m_25fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+#endif
+
+static int pCus_init_5m_30fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_5m_30fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_5m_30fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_5m_30fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_5m_30fps_init_table_4lane_linear[i].reg, Sensor_5m_30fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_5m_30fps_init_table_4lane_linear[i].reg, Sensor_5m_30fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_5m_30fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_5m_30fps_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_5m_30fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_5m_30fps_init_table_4lane_linear[i].reg, Sensor_5m_30fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+
+static int pCus_init_4p8m_30fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_4p8m_30fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_4p8m_30fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_4p8m_30fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_4p8m_30fps_init_table_4lane_linear[i].reg, Sensor_4p8m_30fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_4p8m_30fps_init_table_4lane_linear[i].reg, Sensor_4p8m_30fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_4p8m_30fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_4p8m_30fps_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_4p8m_30fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_4p8m_30fps_init_table_4lane_linear[i].reg, Sensor_4p8m_30fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_3p6m_30fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_3p6m_30fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_3p6m_30fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_3p6m_30fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_3p6m_30fps_init_table_4lane_linear[i].reg, Sensor_3p6m_30fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_3p6m_30fps_init_table_4lane_linear[i].reg, Sensor_3p6m_30fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_3p6m_30fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_3p6m_30fps_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_3p6m_30fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_3p6m_30fps_init_table_4lane_linear[i].reg, Sensor_3p6m_30fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_2m_60fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_2m_60fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_2m_60fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_2m_60fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_2m_60fps_init_table_4lane_linear[i].reg, Sensor_2m_60fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_1m_120fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_1m_120fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_1m_120fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_1m_120fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_1m_120fps_init_table_4lane_linear[i].reg, Sensor_1m_120fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+        }
+    }
+
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_init_1m_135fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_1m_135fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_1m_135fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_1m_135fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_1m_135fps_init_table_4lane_linear[i].reg, Sensor_1m_135fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+        }
+    }
+
+    return SUCCESS;
+}
+#endif
+
+#if 0
+static int pCus_init_8m_30fps_mipi4lane_linear(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle) == FAIL) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_8m_30fps_init_table_4lane_linear);i++)
+    {
+        if(Sensor_8m_30fps_init_table_4lane_linear[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_8m_30fps_init_table_4lane_linear[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_8m_30fps_init_table_4lane_linear[i].reg, Sensor_8m_30fps_init_table_4lane_linear[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_8m_30fps_init_table_4lane_linear[i].reg, Sensor_8m_30fps_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_8m_30fps_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_8m_30fps_init_table_4lane_linear[i].data != sen_data)
+                printk("R/W Differ Reg: 0x%x\n",Sensor_8m_30fps_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_8m_30fps_init_table_4lane_linear[i].reg, Sensor_8m_30fps_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+#endif
+
+static int pCus_init_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_HDR_DOL[i].reg,Sensor_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_HDR_DOL[i].reg, Sensor_init_table_4lane_HDR_DOL[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_4lane_HDR_DOL[i].reg, &sen_data );
+            if(Sensor_init_table_4lane_linear[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_init_table_4lane_HDR_DOL[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane_HDR_DOL[i].reg, Sensor_init_table_4lane_HDR_DOL[i].data, sen_data);
+#endif
+        }
+    }
+
+    SENSOR_DMSG("Sensor IMX415 HDR MODE Initial Finished\n");
+    return SUCCESS;
+}
+
+static int pCus_init_8m_20fps_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_8m_20fps_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].reg,Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].reg, Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].data);
+#if 0
+            SensorReg_Read(Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].reg, &sen_data );
+            if(Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].reg, Sensor_8m_20fps_init_table_4lane_HDR_DOL[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_8m_30fps_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_8m_30fps_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].reg,Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].reg, Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].data);
+#if 0
+            SensorReg_Read(Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].reg, &sen_data );
+            if(Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].reg, Sensor_8m_30fps_init_table_4lane_HDR_DOL[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_init_5m_30fps_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_5m_30fps_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_5m_30fps_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_5m_30fps_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_5m_30fps_init_table_4lane_HDR_DOL[i].reg,Sensor_5m_30fps_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data);
+#if 0
+            SensorReg_Read(Sensor_init_table_4lane_linear[i].reg, &sen_data );
+            if(Sensor_init_table_4lane_linear[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_init_table_4lane_linear[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data, sen_data);
+#endif
+        }
+    }
+
+    return SUCCESS;
+}
+
+#if 0
+static int pCus_init_5m_15fps_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+    int i,cnt=0;
+    //s16 sen_data;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+
+    for(i=0;i< ARRAY_SIZE(Sensor_5m_15fps_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_5m_15fps_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_5m_15fps_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_5m_15fps_init_table_4lane_HDR_DOL[i].reg,Sensor_5m_15fps_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_linear[i].reg, Sensor_init_table_4lane_linear[i].data);
+        }
+    }
+
+    printk("Sensor IMX415 HDR MODE Initial Finished\n");
+    return SUCCESS;
+}
+#endif
+
+static int pCus_init_4p8m_30fps_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+    for(i=0;i< ARRAY_SIZE(Sensor_4p8m_30fps_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].reg,Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].reg, Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].data);
+#if 0
+            SensorReg_Read(Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].reg, &sen_data );
+            if(Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].reg, Sensor_4p8m_30fps_init_table_4lane_HDR_DOL[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_4m_30fps_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+    for(i=0;i< ARRAY_SIZE(Sensor_4m_30fps_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].reg,Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].reg, Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].data);
+#if 0
+            SensorReg_Read(Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].reg, &sen_data );
+            if(Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].reg, Sensor_4m_30fps_init_table_4lane_HDR_DOL[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_init_2m_30fps_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+    int i,cnt=0;
+
+    if (pCus_CheckSensorProductID(handle)) {
+        return FAIL;
+    }
+    for(i=0;i< ARRAY_SIZE(Sensor_2m_30fps_init_table_4lane_HDR_DOL);i++)
+    {
+        if(Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].reg,Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].data) != SUCCESS)
+            {
+                cnt++;
+                if(cnt>=10)
+                {
+                    SENSOR_EMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //SENSOR_UDELAY(1);
+            }
+            //printk("\n reg 0x%x, 0x%x",Sensor_init_table_4lane_linear[i].reg, Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].data);
+#if 0
+            SensorReg_Read(Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].reg, &sen_data );
+            if(Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].data != sen_data)
+                printk("HDR R/W Differ Reg: 0x%x\n",Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].reg);
+                //printk("IMX415 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].reg, Sensor_2m_30fps_init_table_4lane_HDR_DOL[i].data, sen_data);
+#endif
+        }
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    handle->video_res_supported.ulcur_res = res_idx;
+
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_8m_20fps_mipi4lane_linear;
+            vts_30fps = 2813;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 20;
+            Preview_line_period = 17778; // 49.86ms/2813 = 17725ns
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            handle->pCus_sensor_init = pCus_init_6m_30fps_mipi4lane_linear;
+            vts_30fps = 2250;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period = 14815;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+        case 2:
+            handle->video_res_supported.ulcur_res = 2;
+            handle->pCus_sensor_init = pCus_init_5p3m_30fps_mipi4lane_linear;
+            vts_30fps = 2250;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period = 14815;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+        case 3:
+            handle->video_res_supported.ulcur_res = 3;
+            handle->pCus_sensor_init = pCus_init_5m_30fps_mipi4lane_linear;
+            vts_30fps = 2144;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 25;
+            Preview_line_period = 15547;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+        case 4:
+            handle->video_res_supported.ulcur_res = 4;
+            handle->pCus_sensor_init = pCus_init_4p8m_30fps_mipi4lane_linear;
+            vts_30fps = 2250;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 25;
+            Preview_line_period = 14815;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+        case 5:
+            handle->video_res_supported.ulcur_res = 5;
+            handle->pCus_sensor_init = pCus_init_3p6m_30fps_mipi4lane_linear;
+            vts_30fps = 2250;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period = 14815;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+        case 6:
+            handle->video_res_supported.ulcur_res = 6;
+            handle->pCus_sensor_init = pCus_init_2m_60fps_mipi4lane_linear;
+            vts_30fps = 2296;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 60;
+            Preview_line_period = 7259;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            break;
+        case 7:
+            handle->video_res_supported.ulcur_res = 7;
+            handle->pCus_sensor_init = pCus_init_1m_120fps_mipi4lane_linear;
+            vts_30fps = 1644;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 120;
+            Preview_line_period = 4866; // 8ms/1644 = 4866ns;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            break;
+#if 0
+        case 8:
+            handle->video_res_supported.ulcur_res = 8;
+            handle->pCus_sensor_init = pCus_init_1m_135fps_mipi4lane_linear;
+            vts_30fps = 1507;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 120;
+            Preview_line_period = 4645; // 7ms/1507 = 4645ns;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            break;
+#endif
+        default:
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_8m_20fps_mipi4lane_linear;
+            vts_30fps = 2813;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 20;
+            Preview_line_period = 17725; // 49.86ms/2813 = 17725ns
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL_LEF(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    handle->video_res_supported.ulcur_res = res_idx;
+
+    switch (res_idx) {
+        case HDR_RES_1:
+        case HDR_RES_7:
+            handle->data_prec = CUS_DATAPRECISION_12;
+            break;
+        case HDR_RES_2:
+        case HDR_RES_3:
+        case HDR_RES_4:
+        case HDR_RES_5:
+        case HDR_RES_6:
+            handle->data_prec = CUS_DATAPRECISION_10;
+            break;
+        default:
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_HDR_DOL_SEF(ms_cus_sensor *handle, u32 res_idx)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        SENSOR_EMSG("[%s] Please check the number of resolutions supported by the sensor!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    handle->video_res_supported.ulcur_res = res_idx;
+
+    switch (res_idx) {
+        case HDR_RES_1:
+            handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 2250;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 15;
+            Preview_line_period_HDR_DOL_4LANE = 29630;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            params->min_rhs1 = 437;     // 4n+1 fix to 269, 337 //5ms: 429
+            break;
+        case HDR_RES_2:
+            handle->pCus_sensor_init = pCus_init_8m_20fps_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 3450;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 20;
+            Preview_line_period_HDR_DOL_4LANE = 14493;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            params->min_rhs1 = 437;     // 4n+1 fix to 269, 337 //5ms: 429
+            break;
+        case HDR_RES_3:
+            handle->pCus_sensor_init = pCus_init_8m_30fps_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 2300;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 14493;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            params->min_rhs1 = 437;     // 4n+1 fix to 269, 337 //5ms: 429
+            break;
+        case HDR_RES_4:
+            handle->pCus_sensor_init = pCus_init_5m_30fps_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 2300;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 14493;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            params->min_rhs1 = 437;     // 4n+1 fix to 269, 337 //5ms: 429
+            break;
+        case HDR_RES_5:
+            handle->pCus_sensor_init = pCus_init_4p8m_30fps_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 2300;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 14493;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            params->min_rhs1 = 365;     // 4n+1 fix to 269, 337 //5ms: 429
+            break;
+        case HDR_RES_6:
+            handle->pCus_sensor_init = pCus_init_4m_30fps_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 2300;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 14493;
+            handle->data_prec = CUS_DATAPRECISION_10;
+            params->min_rhs1 = 365;     // 4ms: 343 //5ms: 429
+            break;
+        case HDR_RES_7:
+            handle->pCus_sensor_init = pCus_init_2m_30fps_mipi4lane_HDR_DOL;
+            vts_30fps_HDR_DOL_4lane = 2296;
+            params->expo.vts = vts_30fps_HDR_DOL_4lane;
+            params->expo.fps = 30;
+            Preview_line_period_HDR_DOL_4LANE = 14518;
+            handle->data_prec = CUS_DATAPRECISION_12;
+            params->min_rhs1 = 437;     // 4n+1 fix to 269, 337 //5ms: 429
+            break;
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    s16 sen_data;
+
+    //Read SENSOR MIRROR-FLIP STATUS
+    SensorReg_Read(MIRROR_FLIP, (void*)&sen_data);
+
+    switch(sen_data & SENSOR_MIRROR_FLIP_EN)
+    {
+        case SENSOR_NOR:
+            *orit = CUS_ORIT_M0F0;
+            break;
+        case SENSOR_FLIP_EN:
+            *orit = CUS_ORIT_M0F1;
+            break;
+        case SENSOR_MIRROR_EN:
+            *orit = CUS_ORIT_M1F0;
+            break;
+        case SENSOR_MIRROR_FLIP_EN:
+            *orit = CUS_ORIT_M1F1;
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+
+    handle->orient = orit;
+    params->orien_dirty = true;
+
+    return SUCCESS;
+}
+
+static int DoOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    s16 sen_data;
+    //Read SENSOR MIRROR-FLIP STATUS
+    SensorReg_Read(MIRROR_FLIP, (void*)&sen_data);
+    sen_data &= ~(SENSOR_MIRROR_FLIP_EN);
+
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            //sen_data |= SENSOR_NOR;
+            handle->orient = CUS_ORIT_M0F0;
+            break;
+        case CUS_ORIT_M1F0:
+            sen_data |= SENSOR_MIRROR_EN;
+            handle->orient = CUS_ORIT_M1F0;
+            break;
+        case CUS_ORIT_M0F1:
+            sen_data |= SENSOR_FLIP_EN;
+            handle->orient = CUS_ORIT_M0F1;
+            break;
+        case CUS_ORIT_M1F1:
+            sen_data |= SENSOR_MIRROR_FLIP_EN;
+            handle->orient = CUS_ORIT_M1F1;
+            break;
+        default :
+            handle->orient = CUS_ORIT_M0F0;
+            break;
+    }
+    //Write SENSOR MIRROR-FLIP STATUS
+    SensorReg_Write(MIRROR_FLIP, sen_data);
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    //u32 vts = 0, cur_vts_30fps = 0;
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+    //pr_info("[%s]  leslie_fps,maxfps,minfps : %d,%d,%d\n\n", __FUNCTION__,fps,max_fps,min_fps);
+    //cur_vts_30fps = vts_30fps;
+    //pr_info("[%s]  leslie_vts_30fps : %u\n\n", __FUNCTION__,vts_30fps);
+    if(fps>=min_fps && fps <= max_fps){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk) {
+            fps = fps>29?29:fps;              //limit fps at 29 fps due to MCLK=36MHz
+            params->expo.vts=  (vts_30fps*29091 + fps * 500)/(fps * 1000);
+        }
+        else
+            params->expo.vts=  (vts_30fps*(max_fps*1000) + fps * 500)/(fps * 1000);
+    }else if(fps>=(min_fps*1000) && fps <= (max_fps*1000)){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk) {
+            fps = fps>29091?29091:fps;       //limit fps at 29.091 fps due to MCLK=36MHz
+            params->expo.vts=  (vts_30fps*29091 + (fps>>1))/fps;
+        }
+        else
+            params->expo.vts=  (vts_30fps*(max_fps*1000) + (fps>>1))/fps;
+    }else{
+      SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+      return FAIL;
+    }
+    //pr_info("[%s]  leslie_vts : %u\n\n", __FUNCTION__,params->expo.vts);
+    if(params->expo.expo_lines > params->expo.vts - 4){
+        //vts = params->expo.expo_lines + 4;
+#if 0        //Update FPS Status
+        if(fps>=3 && fps <= 30)
+            fps = (vts_30fps*30000)/(params->expo.vts * 1000 - 500);
+        else if(fps>=3000 && fps <= 30000)
+            fps = (vts_30fps*30000)/(params->expo.vts - (500 / 1000));
+#endif
+    }else{
+        //vts = params->expo.vts;
+    }
+
+    params->expo.fps = fps;
+    params->dirty = true;
+
+    pCus_SetAEUSecs(handle, params->expo.expo_lef_us);
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_SEF(ms_cus_sensor *handle)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (cur_vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (cur_vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_SEF(ms_cus_sensor *handle, u32 fps)
+{
+    u32 cur_vts_30fps = 0;
+    imx415_params *params = (imx415_params *)handle->private_data;
+       u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+    //cur_vts_30fps = imx415_mipi_hdr[0].senout.height;
+    cur_vts_30fps=vts_30fps_HDR_DOL_4lane;
+    if(fps>=min_fps && fps <= max_fps){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk) {
+            fps = fps > 14 ? 14 : fps;//limit fps at 29 fps due to MCLK=36MHz
+            params->expo.vts= (cur_vts_30fps*14545 + fps * 500 )/ (fps * 1000);
+        }
+        else
+            params->expo.vts= (cur_vts_30fps*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+
+    }else if(fps>=(min_fps*1000) && fps <= (max_fps*1000)){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk) {
+            fps = fps > 14545 ? 14545 : fps;//limit fps at 29.091 fps due to MCLK=36MHz
+            params->expo.vts= (cur_vts_30fps*14545 + (fps >> 1))/fps;
+        }
+        else
+            params->expo.vts= (cur_vts_30fps*(max_fps*1000) + (fps >> 1))/fps;
+    }else{
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > params->expo.vts - 4){
+        //vts = params->expo.expo_lines + 4;
+#if 0        //Update FPS Status
+        if(fps>=3 && fps <= 30)
+            fps = (vts_30fps*30000)/(params->expo.vts * 1000 - 500);
+        else if(fps>=3000 && fps <= 30000)
+            fps = (vts_30fps*30000)/(params->expo.vts - (500 / 1000));
+#endif
+    }else{
+        //vts = params->expo.vts;
+    }
+
+    params->expo.fps = fps;
+    //params->expo.vts = vts;
+    params->dirty = true;
+
+    pCus_SetAEUSecsHDR_DOL_SEF(handle, params->expo.expo_sef_us);
+
+    return SUCCESS;
+}
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    //ISensorIfAPI2 *sensor_if1 = handle->sensor_if_api2;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             break;
+        case CUS_FRAME_ACTIVE:
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1); // Global hold on
+                if(params->dirty) {
+                    SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                    params->dirty = false;
+                }
+
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0); // Global hold off
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_SEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    //imx415_params *params = (imx415_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             break;
+        case CUS_FRAME_ACTIVE:
+#if 0
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1);
+
+                if(params->dirty) {
+                    //SensorRegArrayW((I2C_ARRAY*)params->tExpo_reg, ARRAY_SIZE(expo_reg));
+                    //SensorRegArrayW((I2C_ARRAY*)params->tGain_reg, ARRAY_SIZE(gain_reg));
+                    //SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg));
+                    params->dirty = false;
+                }
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+            }
+#endif
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us)
+{
+    u32 lines = 0;
+    imx415_params *params = (imx415_params *)handle->private_data;
+
+    lines |= (u32)(params->tExpo_reg[0].data & 0x03) << 16;
+    lines |= (u32)(params->tExpo_reg[1].data & 0xff) << 8;
+    lines |= (u32)(params->tExpo_reg[2].data & 0xff) << 0;
+
+    *us = (lines * Preview_line_period) / 1000;
+
+    SENSOR_DMSG("[%s] sensor expo lines/us %u,%u us\n", __FUNCTION__, lines, *us);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us)
+{
+    u32 expo_lines = 0, vts = 0, SHR0 = 0;
+    imx415_params *params = (imx415_params *)handle->private_data;
+
+    params->expo.expo_lef_us = us;
+    expo_lines = (1000*us)/Preview_line_period;
+
+    if (expo_lines > params->expo.vts) {
+        vts = expo_lines + 8;
+    }
+    else
+      vts = params->expo.vts;
+    SHR0 =  vts - expo_lines;
+
+    if (SHR0 <= 12 )  // 8+4
+        SHR0 = 8;
+    else
+        SHR0 -= 4;
+
+    params->expo.expo_lines = expo_lines;
+    //params->expo.vts = vts;
+
+    SENSOR_DMSG("[%s] us %u, SHR0 %u, vts %u\n", __FUNCTION__,
+                                                 us,  \
+                                                 SHR0, \
+                                                 vts
+               );
+    //pr_info("[%s]  leslie_shutter,expo_lines,params_expo_lines : %d,%d,%d\n\n", __FUNCTION__,us,expo_lines,params->expo.expo_lines);
+    //pr_info("[%s]  leslie_shutter_vts : %u,%u\n\n", __FUNCTION__,params->expo.vts,vts);
+    params->tExpo_reg[0].data = (SHR0>>16) & 0x0003;
+    params->tExpo_reg[1].data = (SHR0>>8) & 0x00ff;
+    params->tExpo_reg[2].data = (SHR0>>0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 expo_line_sef = 0;
+    u32 cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    //u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    imx415_params *params = (imx415_params *)handle->private_data;
+
+    cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    //cur_vts_30fps =vts_30fps_HDR_DOL_4lane;
+    expo_line_sef = (1000 * us + (cur_line_period >> 1)) / cur_line_period;
+    params->expo.expo_sef_us = us;
+    //params->min_rhs1 = 437;     // 4n+1 fix to 269, 337 //5ms: 429
+
+    params->min_shr1 = params->min_rhs1 - expo_line_sef;
+    if((expo_line_sef > params->min_rhs1) || ((params->min_shr1) <  9))
+        params->min_shr1 = 9;
+    params->min_shr1 = ((params->min_shr1 >> 1) << 1) + 1;
+
+    SENSOR_DMSG("[%s] us %u, expo_line_sef %u rhs %u shr1 %u\n", __FUNCTION__,
+                                                                 us, \
+                                                                 expo_line_sef, \
+                                                                 params->min_rhs1, \
+                                                                 params->min_shr1
+               );
+
+    params->tRHS1_reg[0].data = (params->min_rhs1 >>16) & 0x03;
+    params->tRHS1_reg[1].data = (params->min_rhs1 >>8) & 0xff;
+    params->tRHS1_reg[2].data = (params->min_rhs1 >>0) & 0xff;
+
+    params->tSHR1_reg[0].data = (params->min_shr1 >> 16) & 0x0003;
+    params->tSHR1_reg[1].data = (params->min_shr1 >> 8) & 0x00ff;
+    params->tSHR1_reg[2].data = (params->min_shr1 >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+#if 0
+    u16 temp_gain;
+
+    temp_gain=gain_reg[0].data;
+    *gain=(u32)(10^((temp_gain*3)/200))*1024;
+    if (gain_reg[1].data & 0x10)
+       *gain = (*gain) * 2;
+#endif
+    *gain = params->expo.final_gain;
+    SENSOR_DMSG("[%s] get gain %u\n", __FUNCTION__, *gain);
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 i;
+    CUS_GAIN_GAP_ARRAY* Sensor_Gain_Linearity;
+    u64 gain_double;
+
+    params->expo.final_gain = gain;
+    if(gain < SENSOR_MIN_GAIN)
+        gain = SENSOR_MIN_GAIN;
+    else if(gain >= SENSOR_MAX_GAIN)
+        gain = SENSOR_MAX_GAIN;
+
+    Sensor_Gain_Linearity = gain_gap_compensate;
+
+    for(i = 0; i < sizeof(gain_gap_compensate)/sizeof(CUS_GAIN_GAP_ARRAY); i++){
+        if (Sensor_Gain_Linearity[i].gain == 0)
+            break;
+        if((gain>Sensor_Gain_Linearity[i].gain) && (gain < (Sensor_Gain_Linearity[i].gain + Sensor_Gain_Linearity[i].offset))){
+              gain=Sensor_Gain_Linearity[i].gain;
+              break;
+        }
+    }
+    gain_double = 20 * (intlog10(gain) - intlog10(1024));
+    gain_double = (u16)((gain_double * 10) >> 24) / 3;
+
+    params->tGain_reg[0].data = gain_double & 0xff;
+    params->tGain_reg[1].data = (gain_double >> 8) & 0xff;
+
+#if DEBUG_INFO
+    SENSOR_DMSG("[%s]gain %u gain_double %llu\n",__FUNCTION__, gain, gain_double);
+#endif
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x 0x%x\n", __FUNCTION__, gain,params->tGain_reg[0].data, gain,params->tGain_reg[1].dat);
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static void pCus_SetAEGainHDR_DOL_Calculate(u32 gain, u16 *gain_reg)
+{
+    //double gain_double;
+    u64 gain_double;
+
+    if(gain < SENSOR_MIN_GAIN){
+      gain = SENSOR_MIN_GAIN;
+    }
+    else if(gain >= SENSOR_MAX_GAIN){
+      gain = SENSOR_MAX_GAIN;
+    }
+    gain_double = 20 * (intlog10(gain) - intlog10(1024));
+    *gain_reg =(u16)((gain_double * 10) >> 24) / 3;
+}
+
+static int pCus_SetAEGainHDR_DOL_SEF1(ms_cus_sensor *handle, u32 gain)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_sef_reg[0].data = gain_reg & 0xff;
+    params->tGain_hdr_dol_sef_reg[1].data = (gain_reg >> 8) & 0xff;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x 0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_sef_reg[0].data, params->tGain_hdr_dol_sef_reg[1].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx415_mipi_linear[0].senout.min_fps;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = SENSOR_MIN_GAIN;//handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;//10^(72db/20)*1024;
+    return SUCCESS;
+}
+
+static int IMX415_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx415_mipi_linear[0].senout.min_fps;//
+    info->min = (Preview_line_period * 1);
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+
+static int IMX415_GetShutterInfo_HDR_DOL_SEF(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    info->max = Preview_line_period_HDR_DOL_4LANE * params->min_rhs1;
+    info->min = (Preview_line_period_HDR_DOL_4LANE * 5);
+    info->step = Preview_line_period_HDR_DOL_4LANE;
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx415_params *params;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx415_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg, sizeof(vts_reg));
+    memcpy(params->tGain_reg, gain_reg, sizeof(gain_reg));
+    memcpy(params->tExpo_reg, expo_reg, sizeof(expo_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX415_MIPI");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D8;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x34;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //300000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    //handle->mclk                  = UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+    handle->mclk                    = Preview_MCLK_SPEED;
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+    handle->orient                = SENSOR_ORIT;
+    //handle->YC_ODER               = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num    = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order   = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode  = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode    = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+   //handle->video_res_supported.num_res = LINEAR_RES_END;
+    for (res = 0; res < LINEAR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx415_mipi_linear[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx415_mipi_linear[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx415_mipi_linear[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx415_mipi_linear[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx415_mipi_linear[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx415_mipi_linear[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx415_mipi_linear[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx415_mipi_linear[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx415_mipi_linear[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY              = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY             = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY             = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY             = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    //handle->PCLK_POLARITY              = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release        = cus_camsensor_release_handle;
+    handle->pCus_sensor_init           = pCus_init_mipi4lane_linear;
+    //handle->pCus_sensor_powerupseq     = pCus_powerupseq;
+    handle->pCus_sensor_poweron        = pCus_poweron;
+    handle->pCus_sensor_poweroff       = pCus_poweroff;
+    handle->pCus_sensor_GetSensorID    = pCus_GetSensorID;
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes    = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien       = pCus_GetOrien;
+    handle->pCus_sensor_SetOrien       = pCus_SetOrien;
+    handle->pCus_sensor_GetFPS         = pCus_GetFPS;
+    handle->pCus_sensor_SetFPS         = pCus_SetFPS;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = imx415_SetPatternMode; //NONE
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT;
+    handle->ae_gain_ctrl_num           = 1;
+    handle->ae_shutter_ctrl_num        = 1;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;//g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    //sensor calibration
+    //handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    //handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo  = IMX415_GetShutterInfo;
+
+    params->expo.vts = vts_30fps;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_sef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx415_params *params = NULL;
+    int res;
+
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    ////////////////////////////////////
+    // private data allocation & init //
+    ////////////////////////////////////
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    params = (imx415_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg_hdr, sizeof(vts_reg_hdr));
+    memcpy(params->tRHS1_reg, expo_RHS1_reg, sizeof(expo_RHS1_reg));
+    memcpy(params->tSHR1_reg, expo_SHR1_reg, sizeof(expo_SHR1_reg));
+    memcpy(params->tGain_hdr_dol_sef_reg, gain_HDR_DOL_SEF_reg, sizeof(gain_HDR_DOL_SEF_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX415_MIPI_HDR_SEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    handle->mclk                  = Preview_MCLK_SPEED_HDR_DOL;
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //handle->isp_type              = SENSOR_ISP_TYPE;
+    //handle->data_fmt              = SENSOR_DATAFMT;
+    handle->sif_bus               = SENSOR_IFBUS_TYPE;
+    handle->data_prec             = SENSOR_DATAPREC_DOL;
+    handle->data_mode             = SENSOR_DATAMODE;
+    handle->bayer_id              = SENSOR_BAYERID_HDR_DOL;
+    handle->RGBIR_id              = SENSOR_RGBIRID;
+
+    handle->interface_attr.attr_mipi.mipi_lane_num                = 4; // hdr_lane_num;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB;
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_DCG;  // SONY IMX415 as VC mode
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    //handle->video_res_supported.num_res = HDR_RES_END;
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx415_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx415_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx415_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx415_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx415_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx415_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx415_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx415_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx415_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY              = SENSOR_PWDN_POL;      //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY             = SENSOR_RST_POL;       //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY             = SENSOR_VSYNC_POL;     //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY             = SENSOR_HSYNC_POL;     //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY              = SENSOR_PCLK_POL;      //CUS_CLK_POL_POS);  // use '!' to clear board latch error
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    handle->pCus_sensor_release        = cus_camsensor_release_handle;
+    handle->pCus_sensor_init           = pCus_init_mipi4lane_HDR_DOL;
+    handle->pCus_sensor_poweron        = pCus_poweron;               // Need to check
+    handle->pCus_sensor_poweroff       = pCus_poweroff;              // Need to check
+    handle->pCus_sensor_GetSensorID    = pCus_GetSensorID;           // Need to check
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes_HDR_DOL_SEF;   // Need to check
+    handle->pCus_sensor_GetVideoRes    = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes = pCus_GetCurVideoRes;
+
+    handle->pCus_sensor_GetOrien       = pCus_GetOrien;              // Need to check
+    handle->pCus_sensor_SetOrien       = pCus_SetOrien;              // Need to check
+    handle->pCus_sensor_GetFPS         = pCus_GetFPS_HDR_DOL_SEF;    // Need to check
+    handle->pCus_sensor_SetFPS         = pCus_SetFPS_HDR_DOL_SEF;    // Need to check
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay              = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay           = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num           = 2;
+    handle->ae_shutter_ctrl_num        = 2;
+    handle->sat_mingain                = SENSOR_MIN_GAIN;      //g_sensor_ae_min_gain;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_SEF;  // Need to check
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_SEF;      // Need to check
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_SEF1;      // Need to check
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    handle->pCus_sensor_GetShutterInfo  = IMX415_GetShutterInfo_HDR_DOL_SEF;
+    params->expo.vts = vts_30fps_HDR_DOL_4lane;
+
+    return SUCCESS;
+}
+
+//lef functions
+static int pCus_init_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweron_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweroff_HDR_DOL_LEF(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_GetSensorID_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *id)
+{
+     return SUCCESS;
+}
+
+static int pCus_GetOrien_HDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    return SUCCESS;
+}
+
+static int pCus_SetOrien_HDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+
+    handle->orient = orit;
+    params->orien_dirty = true;
+
+    return SUCCESS;
+}
+
+static int pCus_GetFPS_HDR_DOL_LEF(ms_cus_sensor *handle)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (params->tVts_reg[0].data << 16) | (params->tVts_reg[1].data << 8) | (params->tVts_reg[2].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (cur_vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (cur_vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_LEF(ms_cus_sensor *handle, u32 fps)
+{
+    u32 cur_vts_30fps = 0;//vts = 0,
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+   // cur_vts_30fps = imx415_mipi_hdr[0].senout.height;
+    cur_vts_30fps=vts_30fps_HDR_DOL_4lane;
+    if(fps>=min_fps && fps <= max_fps){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk) {
+            fps = fps>14?14:fps;//limit fps at 29 fps due to MCLK=36MHz
+            params->expo.vts=  (cur_vts_30fps*14545 + fps * 500 )/ (fps * 1000);
+        }
+        else
+            params->expo.vts=  (cur_vts_30fps*(max_fps*1000) + fps * 500 )/ (fps * 1000);
+
+    }else if(fps>=(min_fps*1000) && fps <= (max_fps*1000)){
+        if (CUS_CMU_CLK_36MHZ == handle->mclk) {
+            fps = fps>14?14:fps;//limit fps at 29.091 fps due to MCLK=36MHz
+            params->expo.vts=  (cur_vts_30fps*14545 + (fps >> 1))/fps;
+        }
+        else
+            params->expo.vts=  (cur_vts_30fps*(max_fps*1000) + (fps >> 1))/fps;
+
+    }else {
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.expo_lines > params->expo.vts - 4) {
+        //vts = params->expo.expo_lines + 4;
+    }else {
+        //vts = params->expo.vts;
+    }
+
+    params->dirty = true;
+    params->expo.fps = fps;
+    pCus_SetAEUSecsHDR_DOL_LEF(handle, params->expo.expo_sef_us);
+
+    return SUCCESS;
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    //ISensorIfAPI2 *sensor_if1 = handle->sensor_if_api2;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+
+             break;
+        case CUS_FRAME_ACTIVE:
+
+            if(params->dirty || params->orien_dirty) {
+                SensorReg_Write(0x3001,1);
+                if(params->dirty) {
+                    SensorRegArrayW((I2C_ARRAY*)params->tVts_reg, ARRAY_SIZE(vts_reg_hdr));
+                    SensorRegArrayW((I2C_ARRAY*)params->tSHR0_reg, ARRAY_SIZE(expo_SHR0_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tSHR1_reg, ARRAY_SIZE(expo_SHR1_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tRHS1_reg, ARRAY_SIZE(expo_RHS1_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_lef_reg, ARRAY_SIZE(gain_HDR_DOL_LEF_reg));
+                    SensorRegArrayW((I2C_ARRAY*)params->tGain_hdr_dol_sef_reg, ARRAY_SIZE(gain_HDR_DOL_SEF_reg));
+                    params->dirty = false;
+                }
+                if(params->orien_dirty) {
+                    DoOrien(handle, handle->orient);
+                    params->orien_dirty = false;
+                }
+                SensorReg_Write(0x3001,0);
+            }
+            break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetAEUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *us)
+{
+    *us = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us)
+{
+    u32 expo_lines_lef = 0, vts = 0, fsc = 0;
+    u32 cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    //u32 cur_vts_30fps = vts_30fps_HDR_DOL_4lane;
+    imx415_params *params = (imx415_params *)handle->private_data;
+    cur_line_period = Preview_line_period_HDR_DOL_4LANE;
+    //cur_vts_30fps =vts_30fps_HDR_DOL_4lane;
+    expo_lines_lef = (1000 * us + (cur_line_period >> 1)) / cur_line_period;
+
+    params->expo.expo_lef_us = us;
+    fsc = params->expo.vts * 2;
+    params->fsc = ((fsc >> 2) << 2)+ 4;                  // 4n
+
+    //params->max_shr0 = fsc - expo_lines_lef - 8;
+    params->max_shr0 = (fsc - 8) - expo_lines_lef;
+    if(params->max_shr0 < (params->min_rhs1+9))
+        params->max_shr0 = params->min_rhs1+9;
+    params->max_shr0 = ((params->max_shr0 >> 1) << 1) + 2;
+
+    if (expo_lines_lef > (fsc - params->min_rhs1 - 9)) {
+        vts = (expo_lines_lef + params->min_rhs1 + 9) / 2;
+    }
+    else{
+      vts = params->expo.vts;
+    }
+    params->expo.expo_lines = expo_lines_lef;
+    //params->expo.vts = vts;
+
+    SENSOR_DMSG("[%s] us %u, expo_lines_lef %u, vts %u, SHR0 %u \n", __FUNCTION__,
+                                                                     us, \
+                                                                     expo_lines_lef, \
+                                                                     vts, \
+                                                                     params->max_shr0
+                );
+    params->tSHR0_reg[0].data = (params->max_shr0 >> 16) & 0x0003;
+    params->tSHR0_reg[1].data = (params->max_shr0 >> 8) & 0x00ff;
+    params->tSHR0_reg[2].data = (params->max_shr0 >> 0) & 0x00ff;
+
+    params->tVts_reg[0].data = (vts >> 16) & 0x0003;
+    params->tVts_reg[1].data = (vts >> 8) & 0x00ff;
+    params->tVts_reg[2].data = (vts >> 0) & 0x00ff;
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32* gain)
+{
+    *gain = 0;
+    return SUCCESS;
+}
+
+static int pCus_SetAEGainHDR_DOL_LEF(ms_cus_sensor *handle, u32 gain)
+{
+    imx415_params *params = (imx415_params *)handle->private_data;
+    u16 gain_reg = 0;
+
+    pCus_SetAEGainHDR_DOL_Calculate(gain, &gain_reg);
+    params->tGain_hdr_dol_lef_reg[0].data = gain_reg & 0xff;
+    params->tGain_hdr_dol_lef_reg[1].data = (gain_reg >> 8) & 0xff;
+
+    SENSOR_DMSG("[%s] set gain/reg=%u/0x%x\n", __FUNCTION__, gain, params->tGain_hdr_dol_lef_reg[0].data, params->tGain_hdr_dol_lef_reg[1].data);
+
+    params->dirty = true;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = handle->sat_mingain;
+    *max = SENSOR_MAX_GAIN;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxUSecs_HDR_DOL_LEF(ms_cus_sensor *handle, u32 *min, u32 *max)
+{
+    *min = 1;
+    *max = 1000000/imx415_mipi_hdr[0].senout.min_fps;
+    return SUCCESS;
+}
+
+#if 0
+//static int pCus_GetDGainRemainder(ms_cus_sensor *handle, u32 *dgain_remainder)
+//{
+//    *dgain_remainder = handle->dgain_remainder;
+
+//    return SUCCESS;
+//}
+
+static int pCus_SetAEGain_cal_hdr_dol_lef(ms_cus_sensor *handle, u32 gain)
+{
+    return SUCCESS;
+}
+
+static int pCus_setCaliData_gain_linearity_hdr_dol_lef(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num)
+{
+    return SUCCESS;
+}
+#endif
+
+static int IMX415_GetShutterInfo_HDR_DOL_LEF(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/imx415_mipi_hdr[0].senout.min_fps;
+    info->min = (Preview_line_period_HDR_DOL_4LANE * 5);
+    info->step = Preview_line_period_HDR_DOL_4LANE;
+    return SUCCESS;
+}
+
+static int cus_camsensor_init_handle_hdr_dol_lef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    imx415_params *params;
+    s32 res;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (imx415_params *)handle->private_data;
+    memcpy(params->tVts_reg, vts_reg_hdr, sizeof(vts_reg_hdr));
+    memcpy(params->tSHR0_reg, expo_SHR0_reg, sizeof(expo_SHR0_reg));
+    memcpy(params->tGain_hdr_dol_lef_reg, gain_HDR_DOL_LEF_reg, sizeof(gain_HDR_DOL_LEF_reg));
+
+    ////////////////////////////////////
+    //    sensor model ID             //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"IMX415_MIPI_HDR_LEF");
+
+    ////////////////////////////////////
+    //    i2c config                  //
+    ////////////////////////////////////
+    handle->i2c_cfg.mode          = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt           = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address       = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed         = SENSOR_I2C_SPEED;     //320000;
+
+    ////////////////////////////////////
+    //    mclk                        //
+    ////////////////////////////////////
+    //handle->mclk                   = UseParaMclk(SENSOR_DRV_PARAM_MCLK());
+    handle->mclk                   = Preview_MCLK_SPEED_HDR_DOL;
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //handle->isp_type             = SENSOR_ISP_TYPE;    //ISP_SOC;
+    //handle->data_fmt             = SENSOR_DATAFMT;     //CUS_DATAFMT_YUV;
+    handle->sif_bus                = SENSOR_IFBUS_TYPE;  //CUS_SENIF_BUS_PARL;
+    handle->data_prec              = SENSOR_DATAPREC_DOL;  //CUS_DATAPRECISION_8;
+    handle->data_mode              = SENSOR_DATAMODE;
+    handle->bayer_id               = SENSOR_BAYERID_HDR_DOL;   //CUS_BAYER_GB;
+    handle->RGBIR_id               = SENSOR_RGBIRID;
+    handle->orient                 = SENSOR_ORIT;        //CUS_ORIT_M1F1;
+    //handle->YC_ODER                = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num                = 4;//hdr_lane_num;
+    handle->interface_attr.attr_mipi.mipi_data_format             = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order               = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode              = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode                = CUS_HDR_MODE_DCG;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Long frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    //handle->video_res_supported.num_res = HDR_RES_END;
+    for (res = 0; res < HDR_RES_END; res++) {
+        handle->video_res_supported.num_res = res+1;
+        handle->video_res_supported.res[res].width         = imx415_mipi_hdr[res].senif.preview_w;
+        handle->video_res_supported.res[res].height        = imx415_mipi_hdr[res].senif.preview_h;
+        handle->video_res_supported.res[res].max_fps       = imx415_mipi_hdr[res].senout.max_fps;
+        handle->video_res_supported.res[res].min_fps       = imx415_mipi_hdr[res].senout.min_fps;
+        handle->video_res_supported.res[res].crop_start_x  = imx415_mipi_hdr[res].senif.crop_start_X;
+        handle->video_res_supported.res[res].crop_start_y  = imx415_mipi_hdr[res].senif.crop_start_y;
+        handle->video_res_supported.res[res].nOutputWidth  = imx415_mipi_hdr[res].senout.width;
+        handle->video_res_supported.res[res].nOutputHeight = imx415_mipi_hdr[res].senout.height;
+        sprintf(handle->video_res_supported.res[res].strResDesc, imx415_mipi_hdr[res].senstr.strResDesc);
+    }
+
+    ////////////////////////////////////
+    //    Sensor polarity             //
+    ////////////////////////////////////
+    handle->pwdn_POLARITY              = SENSOR_PWDN_POL;      //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY             = SENSOR_RST_POL;       //CUS_CLK_POL_NEG;
+    //handle->VSYNC_POLARITY             = SENSOR_VSYNC_POL;     //CUS_CLK_POL_POS;
+    //handle->HSYNC_POLARITY             = SENSOR_HSYNC_POL;     //CUS_CLK_POL_POS;
+    //handle->PCLK_POLARITY              = SENSOR_PCLK_POL;      //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////
+    // Sensor Status Control and Get Info //
+    ////////////////////////////////////////
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release         = cus_camsensor_release_handle;
+    handle->pCus_sensor_init            = pCus_init_HDR_DOL_LEF;
+    //handle->pCus_sensor_powerupseq      = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron         = pCus_poweron_HDR_DOL_LEF;
+    handle->pCus_sensor_poweroff        = pCus_poweroff_HDR_DOL_LEF;
+    handle->pCus_sensor_GetSensorID     = pCus_GetSensorID_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetVideoResNum  = NULL;
+    //handle->pCus_sensor_GetVideoRes     = NULL;
+    //handle->pCus_sensor_GetCurVideoRes  = NULL;
+    handle->pCus_sensor_SetVideoRes    = pCus_SetVideoRes_HDR_DOL_LEF;   // Need to check
+
+
+    handle->pCus_sensor_GetOrien        = pCus_GetOrien_HDR_DOL_LEF;
+    handle->pCus_sensor_SetOrien        = pCus_SetOrien_HDR_DOL_LEF;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_HDR_DOL_LEF;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap_hdr_dol_lef;
+    //handle->pCus_sensor_SetPatternMode  = imx415_SetPatternMode_hdr_dol_lef;
+
+    ////////////////////////////////////
+    //    AE parameters               //
+    ////////////////////////////////////
+    handle->ae_gain_delay               = SENSOR_GAIN_DELAY_FRAME_COUNT;
+    handle->ae_shutter_delay            = SENSOR_SHUTTER_DELAY_FRAME_COUNT_HDR_DOL;
+    handle->ae_gain_ctrl_num            = 2;
+    handle->ae_shutter_ctrl_num         = 2;
+    handle->sat_mingain                 = SENSOR_MIN_GAIN;
+    //handle->dgain_remainder = 0;
+
+    ////////////////////////////////////
+    //  AE Control and Get Info       //
+    ////////////////////////////////////
+    handle->pCus_sensor_AEStatusNotify  = pCus_AEStatusNotifyHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain_HDR_DOL_LEF;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_LEF;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain_HDR_DOL_LEF;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_HDR_DOL_LEF;
+    //handle->pCus_sensor_GetDGainRemainder = pCus_GetDGainRemainder;
+
+    handle->pCus_sensor_GetShutterInfo  = IMX415_GetShutterInfo_HDR_DOL_LEF;
+
+    params->expo.vts = vts_30fps_HDR_DOL_4lane;
+
+    params->dirty = false;
+
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(IMX415_HDR,
+                            cus_camsensor_init_handle_linear,
+                            cus_camsensor_init_handle_hdr_dol_sef,
+                            cus_camsensor_init_handle_hdr_dol_lef,
+                            imx415_params
+                         );
diff --git a/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_sc8235_mipi.c b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_sc8235_mipi.c
new file mode 100644
index 00000000..21905cb1
--- /dev/null
+++ b/general/package/sigmastar-osdrv-sensor/src/infinity6e/sensor/sensor_sc8235_mipi.c
@@ -0,0 +1,5134 @@
+/* SigmaStar trade secret */
+/* Copyright (c) [2019~2020] SigmaStar Technology.
+   All rights reserved.
+
+   Unless otherwise stipulated in writing, any and all information contained
+   herein regardless in any format shall remain the sole proprietary of
+   SigmaStar and be kept in strict confidence
+   (SigmaStar Confidential Information) by the recipient.
+   Any unauthorized act including without limitation unauthorized disclosure,
+   copying, use, reproduction, sale, distribution, modification, disassembling,
+   reverse engineering and compiling of the contents of SigmaStar Confidential
+   Information is unlawful and strictly prohibited. SigmaStar hereby reserves the
+   rights to any and all damages, losses, costs and expenses resulting therefrom.
+ */
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <drv_sensor_common.h>
+#include <sensor_i2c_api.h>
+#include <drv_sensor.h>
+
+#ifdef __cplusplus
+}
+#endif
+
+SENSOR_DRV_ENTRY_IMPL_BEGIN_EX(SC8238_HDR);
+
+#ifndef ARRAY_SIZE
+#define ARRAY_SIZE CAM_OS_ARRAY_SIZE
+#endif
+
+#define SENSOR_PAD_GROUP_SET CUS_SENSOR_PAD_GROUP_A
+#define SENSOR_CHANNEL_NUM (0)
+#define SENSOR_CHANNEL_MODE_LINEAR CUS_SENSOR_CHANNEL_MODE_REALTIME_NORMAL
+#define SENSOR_CHANNEL_MODE_SONY_DOL CUS_SENSOR_CHANNEL_MODE_RAW_STORE_HDR
+
+//============================================
+//MIPI config begin.
+#define SENSOR_MIPI_LANE_NUM (4)
+//#define SENSOR_MIPI_HDR_MODE (2) //0: Non-HDR mode. 1:Sony DOL mode. 2：CUS_HDR_MODE_DCG
+//MIPI config end.
+//============================================
+
+#define R_GAIN_REG 1
+#define G_GAIN_REG 2
+#define B_GAIN_REG 3
+
+
+//#undef SENSOR_DBG
+#define SENSOR_DBG 0
+
+///////////////////////////////////////////////////////////////
+//          @@@                                                                                       //
+//       @   @@      ==  S t a r t * H e r e ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                            //
+//            @@      ==  S t a r t * H e r e  ==                                           //
+//         @@@@                                                                                  //
+//                                                                                                     //
+//      Start Step 1 --  show preview on LCM                                         //
+//                                                                                                    �@//
+//  Fill these #define value and table with correct settings                        //
+//      camera can work and show preview on LCM                                 //
+//                                                                                                       //
+///////////////////////////////////////////////////////////////
+
+#define SENSOR_ISP_TYPE     ISP_EXT                   //ISP_EXT, ISP_SOC
+#define F_number  22                                  // CFG, demo module
+//#define SENSOR_DATAFMT      CUS_DATAFMT_BAYER        //CUS_DATAFMT_YUV, CUS_DATAFMT_BAYER
+#define SENSOR_IFBUS_TYPE   CUS_SENIF_BUS_MIPI      //CFG //CUS_SENIF_BUS_PARL, CUS_SENIF_BUS_MIPI
+#define SENSOR_MIPI_HSYNC_MODE PACKET_HEADER_EDGE1
+#define SENSOR_MIPI_HSYNC_MODE_HDR_DOL PACKET_FOOTER_EDGE
+#define SENSOR_DATAPREC     CUS_DATAPRECISION_10    //CFG //CUS_DATAPRECISION_8, CUS_DATAPRECISION_10
+#define SENSOR_DATAPREC_HDR_DOL     CUS_DATAPRECISION_10
+#define SENSOR_DATAMODE     CUS_SEN_10TO12_9000     //CFG
+//#define SENSOR_MAXGAIN      (15875*315)/10000   /////sensor again 15.875 dgain=31.5
+#define SENSOR_MAXGAIN      500                   /////sensor again 15.875 dgain=31.5
+#define SENSOR_BAYERID      CUS_BAYER_BG            //CFG //CUS_BAYER_GB, CUS_BAYER_GR, CUS_BAYER_BG, CUS_BAYER_RG
+#define SENSOR_BAYERID_HDR_DOL      CUS_BAYER_BG//CUS_BAYER_GR
+#define SENSOR_RGBIRID      CUS_RGBIR_NONE
+#define SENSOR_ORIT         CUS_ORIT_M0F0           //CUS_ORIT_M0F0, CUS_ORIT_M1F0, CUS_ORIT_M0F1, CUS_ORIT_M1F1,
+#define SENSOR_MAX_GAIN     80                 // max sensor again, a-gain
+//#define SENSOR_YCORDER      CUS_SEN_YCODR_YC       //CUS_SEN_YCODR_YC, CUS_SEN_YCODR_CY
+#define lane_number 4
+#define vc0_hs_mode 3   //0: packet header edge  1: line end edge 2: line start edge 3: packet footer edge
+#define long_packet_type_enable 0x00 //UD1~UD8 (user define)
+
+#define Preview_MCLK_SPEED  CUS_CMU_CLK_27MHZ        //CFG //CUS_CMU_CLK_12M, CUS_CMU_CLK_16M, CUS_CMU_CLK_24M, CUS_CMU_CLK_27M
+#define Preview_MCLK_SPEED_HDR_DOL  CUS_CMU_CLK_27MHZ
+
+//#define Preview_line_period 30000                  ////HTS/PCLK=4455 pixels/148.5MHZ=30usec @MCLK=36MHz
+//#define vts_30fps 1125//1346,1616                 //for 29.1fps @ MCLK=36MHz
+//#define Preview_line_period                //(36M/37.125M)*30fps=29.091fps(34.375msec), hts=34.375/1125=30556,
+//#define Line_per_second     32727
+//#define vts_30fps
+u32 Preview_line_period;
+u32 vts_30fps;
+u32 Preview_line_period_HDR_DOL = 14815;
+u32 vts_30fps_HDR_DOL;
+#define Preview_WIDTH       3840                    //resolution Width when preview
+#define Preview_HEIGHT      2160                    //resolution Height when preview
+#define Preview_MAX_FPS     15                     //fastest preview FPS
+#define Preview_MIN_FPS     3                      //slowest preview FPS
+#define Preview_CROP_START_X     0                      //CROP_START_X
+#define Preview_CROP_START_Y     0                      //CROP_START_Y
+
+#define SENSOR_I2C_ADDR    0x60                   //I2C slave address
+#define SENSOR_I2C_SPEED   200000 //300000// 240000                  //I2C speed, 60000~320000
+
+#define SENSOR_I2C_LEGACY  I2C_NORMAL_MODE     //usally set CUS_I2C_NORMAL_MODE,  if use old OVT I2C protocol=> set CUS_I2C_LEGACY_MODE
+#define SENSOR_I2C_FMT     I2C_FMT_A16D8        //CUS_I2C_FMT_A8D8, CUS_I2C_FMT_A8D16, CUS_I2C_FMT_A16D8, CUS_I2C_FMT_A16D16
+
+#define SENSOR_PWDN_POL     CUS_CLK_POL_NEG        // if PWDN pin High can makes sensor in power down, set CUS_CLK_POL_POS
+#define SENSOR_RST_POL      CUS_CLK_POL_NEG        // if RESET pin High can makes sensor in reset state, set CUS_CLK_POL_NEG
+
+// VSYNC/HSYNC POL can be found in data sheet timing diagram,
+// Notice: the initial setting may contain VSYNC/HSYNC POL inverse settings so that condition is different.
+
+#define SENSOR_VSYNC_POL    CUS_CLK_POL_NEG        // if VSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_HSYNC_POL    CUS_CLK_POL_NEG        // if HSYNC pin High and data bus have data, set CUS_CLK_POL_POS
+#define SENSOR_PCLK_POL     CUS_CLK_POL_POS        // depend on sensor setting, sometimes need to try CUS_CLK_POL_POS or CUS_CLK_POL_NEG
+
+#if defined (SENSOR_MODULE_VERSION)
+#define TO_STR_NATIVE(e) #e
+#define TO_STR_PROXY(m, e) m(e)
+#define MACRO_TO_STRING(e) TO_STR_PROXY(TO_STR_NATIVE, e)
+static char *sensor_module_version = MACRO_TO_STRING(SENSOR_MODULE_VERSION);
+module_param(sensor_module_version, charp, S_IRUGO);
+#endif
+static int cus_camsensor_release_handle(ms_cus_sensor *handle);
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain);
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us);
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+static int pCus_SetOrien_HDR(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit);
+//static int sc8238_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info);
+#define ABS(a)   ((a)>(0) ? (a) : (-(a)))
+static int g_sensor_ae_min_gain = 1024;
+
+CUS_MCLK_FREQ UseParaMclk(void);
+
+typedef struct {
+    struct {
+        u16 pre_div0;
+        u16 div124;
+        u16 div_cnt7b;
+        u16 sdiv0;
+        u16 mipi_div0;
+        u16 r_divp;
+        u16 sdiv1;
+        u16 r_seld5;
+        u16 r_sclk_dac;
+        u16 sys_sel;
+        u16 pdac_sel;
+        u16 adac_sel;
+        u16 pre_div_sp;
+        u16 r_div_sp;
+        u16 div_cnt5b;
+        u16 sdiv_sp;
+        u16 div12_sp;
+        u16 mipi_lane_sel;
+        u16 div_dac;
+    } clk_tree;
+    struct {
+        u32 sclk;
+        u32 hts;
+        u32 vts;
+        u32 ho;
+        u32 xinc;
+        u32 line_freq;
+        u32 us_per_line;
+        u32 final_us;
+        u32 final_gain;
+        u32 back_pv_us;
+        u32 half_lines;
+        u32 half_line;
+        u32 fps;
+        u32 preview_fps;
+        u32 max_short_exp;
+        u32 line;
+    } expo;
+    struct {
+        bool bVideoMode;
+        u16 res_idx;
+        //        bool binning;
+        //        bool scaling;
+        CUS_CAMSENSOR_ORIT  orit;
+    } res;
+
+    int sen_init;
+    int still_min_fps;
+    int video_min_fps;
+    bool reg_mf;
+    bool reg_dirty;
+    CUS_CAMSENSOR_ORIT cur_orien;
+} sc8238_params;
+// set sensor ID address and data,
+
+typedef struct {
+    u64 gain;
+    u8 fine_gain_reg;
+} FINE_GAIN;
+
+I2C_ARRAY Sensor_id_table[] =
+{
+    {0x3107, 0x82},
+    {0x3108, 0x35},
+};
+
+I2C_ARRAY Sensor_init_table_4lane_4K30fps[] =
+{
+//0x02_Apollo_30fps_10bit_4lane_708.75Mbps_3840x2160(HTS=4200,VTS=2250).ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x336c,0xc2},
+{0x3624,0x45},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x5799,0x06},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e0e,0x09},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x4837,0x1c},
+{0x3366,0x92},
+{0x3314,0x94},
+{0x334c,0x10},
+{0x3e09,0x40},
+{0x3e08,0x03},
+{0x3637,0x52},
+{0x3631,0x80},
+{0x3308,0x20},
+{0x335d,0x60},
+{0x337f,0x33},
+{0x3368,0x07},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x3367,0x08},
+{0x330e,0x58},
+{0x33af,0x48},
+{0x3638,0x0a},
+{0x3306,0xa8},
+{0x3309,0x68},
+{0x331f,0x59},
+{0x330d,0x28},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x3332,0x24},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x3628,0x83},
+{0x3633,0x53},
+{0x3630,0x80},
+{0x3622,0xf7},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x363a,0x88},
+{0x3e26,0x40},
+{0x360f,0x01},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3670,0x4a},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x3699,0x88},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x3364,0x16},
+{0x3301,0x1c},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3981,0x70},
+{0x3984,0x20},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3980,0x71},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39c5,0x30},
+{0x330b,0x48},
+{0x320c,0x08},
+{0x320d,0x34},
+{0x320e,0x08}, 
+{0x320f,0xca},
+{0x3635,0x02},
+{0x3902,0xc5},
+{0x3038,0x44},
+{0x3632,0x98},
+{0x3e14,0x31},
+{0x3e1b,0x3a},
+{0x3248,0x04},
+{0x3901,0x00},
+{0x3904,0x18},
+{0x3987,0x0b},
+{0x363b,0x06},
+{0x3905,0xd8},
+{0x301f,0x02},
+{0x3203,0x08},
+{0x3207,0x87},
+{0x3213,0x08},
+{0x3e00,0x01},
+{0x3e01,0x18},
+{0x3e02,0xa0},
+{0x3641,0x0c},
+{0x36f9,0x57},
+{0x36fa,0x39},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x36e9,0x53},
+{0x36ea,0x39},
+{0x36eb,0x06},
+{0x36ec,0x05},
+{0x36ed,0x24},
+{0x3641,0x00},
+{0x0100,0x01},
+};
+
+I2C_ARRAY Sensor_init_table_4lane_4K20fps[] =
+{
+//cleaned_0x32_SC8235_MIPI_27Minput_4lane_10bit_472.5Mbps_3840x2160_20fps.ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x301f,0x32},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x3038,0x44},
+{0x320c,0x08},
+{0x320d,0x34},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3248,0x04},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x3301,0x18},
+{0x3306,0x88},
+{0x3308,0x20},
+{0x3309,0x68},
+{0x330b,0x70},
+{0x330d,0x28},
+{0x330e,0x48},
+{0x3314,0x94},
+{0x331f,0x59},
+{0x3332,0x24},
+{0x334c,0x10},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x335d,0x60},
+{0x3364,0x16},
+{0x3366,0x92},
+{0x3367,0x08},
+{0x3368,0x07},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x336c,0xc2},
+{0x337f,0x33},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3399,0x18},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x33af,0x48},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x360f,0x01},
+{0x3622,0xf7},
+{0x3624,0x45},
+{0x3628,0x83},
+{0x3630,0x80},
+{0x3631,0x80},
+{0x3632,0xa8},
+{0x3633,0x53},
+{0x3635,0x02},
+{0x3637,0x52},
+{0x3638,0x0a},
+{0x363a,0x88},
+{0x363b,0x06},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x3670,0x4a},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x3699,0x9f},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x3901,0x00},
+{0x3902,0xc5},
+{0x3904,0x18},
+{0x3905,0xd8},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3980,0x71},
+{0x3981,0x70},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3984,0x20},
+{0x3987,0x0b},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39c5,0x30},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3e00,0x01},
+{0x3e01,0x18},
+{0x3e02,0xa0},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e0e,0x09},
+{0x3e14,0x31},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e1b,0x3a},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x3e26,0x40},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x4837,0x2a},
+{0x5799,0x06},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3641,0x0c},
+{0x36e9,0x56},
+{0x36ea,0x39},
+{0x36eb,0x0e},
+{0x36ec,0x15},
+{0x36ed,0x14},
+{0x36f9,0x11},
+{0x36fa,0x39},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x3641,0x00},
+{0x0100,0x01},
+};
+
+I2C_ARRAY Sensor_init_table_4lane_4K15fps[] =
+{
+//0x20_Apollo_MIPI_27Minput_4lane_10bit_421.875Mbps_3840x2160_15fps_(hts=5000,vts=2250).ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x301f,0x20},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x3038,0x44},
+{0x320c,0x09},
+{0x320d,0xc4},
+{0x320e,0x08},
+{0x320f,0xca},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3248,0x04},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x3301,0x1c},
+{0x3306,0xc0},
+{0x3309,0x40},
+{0x330b,0xc0},
+{0x330e,0x60},
+{0x3314,0x94},
+{0x331f,0x31},
+{0x334c,0x10},
+{0x335d,0x60},
+{0x3364,0x16},
+{0x3366,0x92},
+{0x3367,0x08},
+{0x3368,0x09},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x336c,0xc2},
+{0x337f,0x33},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x33af,0x24},
+{0x33e0,0xa0},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x360f,0x01},
+{0x3622,0xf7},
+{0x3624,0x45},
+{0x3628,0x83},
+{0x3630,0x80},
+{0x3631,0x80},
+{0x3632,0xa8},
+{0x3633,0x22},
+{0x3635,0x02},
+{0x3637,0x29},
+{0x3638,0x08},
+{0x363a,0x88},
+{0x363b,0x06},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x3670,0x4a},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x3699,0x9f},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x3901,0x00},
+{0x3902,0xc5},
+{0x3904,0x18},
+{0x3905,0xd8},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3980,0x71},
+{0x3981,0x70},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3984,0x20},
+{0x3987,0x0b},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x03},
+{0x3995,0xff},
+{0x3996,0x00},
+{0x3997,0x03},
+{0x3998,0x00},
+{0x3999,0x06},
+{0x399a,0x00},
+{0x399b,0x0e},
+{0x399c,0x00},
+{0x399d,0x10},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xee},
+{0x39a6,0x03},
+{0x39a7,0xf4},
+{0x39a8,0x03},
+{0x39a9,0xf6},
+{0x39aa,0x03},
+{0x39ab,0xfd},
+{0x39ac,0x00},
+{0x39ad,0x04},
+{0x39ae,0x00},
+{0x39af,0x06},
+{0x39b0,0x00},
+{0x39b1,0x0e},
+{0x39b2,0x00},
+{0x39b3,0x1c},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39c5,0x30},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x19},
+{0x39e3,0xe9},
+{0x39e4,0x0e},
+{0x39e5,0x14},
+{0x39e6,0x00},
+{0x39e7,0x23},
+{0x39e8,0x03},
+{0x39e9,0xba},
+{0x39ea,0x02},
+{0x39eb,0x6d},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3e00,0x01},
+{0x3e01,0x18},
+{0x3e02,0xa0},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e0e,0x09},
+{0x3e14,0x31},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e1b,0x3a},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x3e26,0x40},
+{0x3f00,0x4a},
+{0x4501,0xb4},
+{0x4509,0x20},
+{0x4837,0x2f},
+{0x5799,0x06},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3641,0x0c},
+{0x36e9,0x52},
+{0x36ea,0xbb},
+{0x36eb,0x14},
+{0x36ec,0x05},
+{0x36ed,0x14},
+{0x36f9,0x52},
+{0x36fa,0xbb},
+{0x36fb,0x14},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x3641,0x00},
+{0x0100,0x01},
+};
+
+I2C_ARRAY Sensor_init_table_4lane_5M30fps[] =
+{
+//cleaned_0x10_SC8235_MIPI_4lane_10bit_708.75Mbps_2592x1944_4200x2250_30fps.ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x301f,0x10},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x3038,0x44},
+{0x3200,0x02},
+{0x3201,0x80},
+{0x3202,0x00},
+{0x3203,0x78},
+{0x3204,0x0c},
+{0x3205,0xa7},
+{0x3206,0x08},
+{0x3207,0x17},
+{0x3208,0x0a},
+{0x3209,0x20},
+{0x320a,0x07},
+{0x320b,0x98},
+{0x320c,0x08},
+{0x320d,0x34},
+{0x3210,0x00},
+{0x3211,0x04},
+{0x3212,0x00},
+{0x3213,0x04},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3248,0x04},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x3301,0x1c},
+{0x3306,0xa8},
+{0x3308,0x20},
+{0x3309,0x68},
+{0x330b,0x48},
+{0x330d,0x28},
+{0x330e,0x58},
+{0x3314,0x94},
+{0x331f,0x59},
+{0x3332,0x24},
+{0x334c,0x10},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x335d,0x60},
+{0x3364,0x16},
+{0x3366,0x92},
+{0x3367,0x08},
+{0x3368,0x07},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x336c,0xc2},
+{0x337f,0x33},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x33af,0x48},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x360f,0x01},
+{0x3622,0xf7},
+{0x3624,0x45},
+{0x3628,0x83},
+{0x3630,0x80},
+{0x3631,0x80},
+{0x3632,0xa8},
+{0x3633,0x53},
+{0x3635,0x02},
+{0x3637,0x52},
+{0x3638,0x0a},
+{0x363a,0x88},
+{0x363b,0x06},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x3670,0x4a},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x3699,0x9f},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x3901,0x00},
+{0x3902,0xc5},
+{0x3904,0x18},
+{0x3905,0xd8},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3980,0x71},
+{0x3981,0x70},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3984,0x20},
+{0x3987,0x0b},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39c5,0x30},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3e00,0x01},
+{0x3e01,0x18},
+{0x3e02,0xa0},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e0e,0x09},
+{0x3e14,0x31},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e1b,0x3a},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x3e26,0x40},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x4837,0x1c},
+{0x5799,0x06},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3641,0x0c},
+{0x36e9,0x53},
+{0x36ea,0x39},
+{0x36eb,0x06},
+{0x36ec,0x05},
+{0x36ed,0x24},
+{0x36f9,0x57},
+{0x36fa,0x39},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x3641,0x00},
+{0x0100,0x01},
+};
+
+I2C_ARRAY Sensor_init_table_4lane_5MP3_30fps[] =
+{
+//new_special_0x02_FT_SC8235_MIPI_27Minput_4lane_10bit_708.75Mbps_3072x1728_30fps.ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x36e9,0x80},
+{0x36f9,0x80},
+{0x336c,0xc2},
+{0x3624,0x45},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x5799,0x06},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e0e,0x09},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x4837,0x1c},
+{0x3366,0x92},
+{0x3314,0x94},
+{0x334c,0x10},
+{0x3e09,0x40},
+{0x3e08,0x03},
+{0x3637,0x52},
+{0x3631,0x80},
+{0x3308,0x20},
+{0x320c,0x08},
+{0x320d,0x34},
+{0x335d,0x60},
+{0x337f,0x33},
+{0x3368,0x07},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x3367,0x08},
+{0x330e,0x58},
+{0x33af,0x48},
+{0x3638,0x0a},
+{0x3306,0xa8},
+{0x3309,0x68},
+{0x331f,0x59},
+{0x330d,0x28},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x3332,0x24},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x3628,0x83},
+{0x3633,0x53},
+{0x3630,0x80},
+{0x3622,0xf7},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x363a,0x88},
+{0x3e26,0x40},
+{0x360f,0x01},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3670,0x4a},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x3699,0x88},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x3364,0x16},
+{0x3301,0x1c},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3981,0x70},
+{0x3984,0x20},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3980,0x71},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39c5,0x30},
+{0x330b,0x48},
+{0x36f9,0x57},
+{0x36fa,0x39},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x36e9,0x53},
+{0x36ea,0x39},
+{0x36eb,0x06},
+{0x36ec,0x05},
+{0x36ed,0x24},
+{0x3635,0x02},
+{0x3902,0xc5},
+{0x3038,0x44},
+{0x3632,0x98},
+{0x3e14,0x31},
+{0x3e1b,0x3a},
+{0x3248,0x04},
+{0x3901,0x00},
+{0x3904,0x18},
+{0x3987,0x0b},
+{0x363b,0x06},
+{0x3905,0xd8},
+{0x301f,0x02},
+{0x3200,0x01},
+{0x3201,0x88},
+{0x3202,0x00},
+{0x3203,0xda},
+{0x3204,0x0d},
+{0x3205,0x97},
+{0x3206,0x07},
+{0x3207,0xa9},
+{0x3208,0x0c},
+{0x3209,0x00},
+{0x320a,0x06},
+{0x320b,0xc0},
+{0x3210,0x00},
+{0x3211,0x08},
+{0x3212,0x00},
+{0x3213,0x08},
+{0x3e00,0x01},
+{0x3e01,0x18},
+{0x3e02,0xa0},
+{0x0100,0x01},
+};
+
+
+I2C_ARRAY Sensor_init_table_4lane_4P8M30fps[] =
+{
+//cleaned_0x11_SC8235_MIPI_4lane_10bit_708.75Mbps_2944x1656_4200x2250_30fps.ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x301f,0x11},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x3038,0x44},
+{0x3200,0x01},
+{0x3201,0xd0},
+{0x3202,0x01},
+{0x3203,0x08},
+{0x3204,0x0d},
+{0x3205,0x57},
+{0x3206,0x07},
+{0x3207,0x87},
+{0x3208,0x0b},
+{0x3209,0x80},
+{0x320a,0x06},
+{0x320b,0x78},
+{0x320c,0x08},
+{0x320d,0x34},
+{0x3210,0x00},
+{0x3211,0x04},
+{0x3212,0x00},
+{0x3213,0x04},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3248,0x04},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x3301,0x1c},
+{0x3306,0xa8},
+{0x3308,0x20},
+{0x3309,0x68},
+{0x330b,0x48},
+{0x330d,0x28},
+{0x330e,0x58},
+{0x3314,0x94},
+{0x331f,0x59},
+{0x3332,0x24},
+{0x334c,0x10},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x335d,0x60},
+{0x3364,0x16},
+{0x3366,0x92},
+{0x3367,0x08},
+{0x3368,0x07},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x336c,0xc2},
+{0x337f,0x33},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x33af,0x48},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x360f,0x01},
+{0x3622,0xf7},
+{0x3624,0x45},
+{0x3628,0x83},
+{0x3630,0x80},
+{0x3631,0x80},
+{0x3632,0xa8},
+{0x3633,0x53},
+{0x3635,0x02},
+{0x3637,0x52},
+{0x3638,0x0a},
+{0x363a,0x88},
+{0x363b,0x06},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x3670,0x4a},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x3699,0x9f},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x3901,0x00},
+{0x3902,0xc5},
+{0x3904,0x18},
+{0x3905,0xd8},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3980,0x71},
+{0x3981,0x70},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3984,0x20},
+{0x3987,0x0b},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39c5,0x30},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3e00,0x01},
+{0x3e01,0x18},
+{0x3e02,0xa0},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e0e,0x09},
+{0x3e14,0x31},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e1b,0x3a},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x3e26,0x40},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x4837,0x1c},
+{0x5799,0x06},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3641,0x0c},
+{0x36e9,0x53},
+{0x36ea,0x39},
+{0x36eb,0x06},
+{0x36ec,0x05},
+{0x36ed,0x24},
+{0x36f9,0x57},
+{0x36fa,0x39},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x3641,0x00},
+{0x0100,0x01},
+
+};
+
+
+I2C_ARRAY Sensor_init_table_4lane_3P6M30fps[] =
+{
+//cleaned_0x1e_SC8235_MIPI_27Minput_4lane_10bit_583.2Mbps_2560x1440_30fps_2592x1500.ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x301f,0x1e},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x3038,0x44},
+{0x3200,0x02},
+{0x3201,0x88},
+{0x3202,0x02},
+{0x3203,0xd8},
+{0x3204,0x0c},
+{0x3205,0x8f},
+{0x3206,0x08},
+{0x3207,0x7f},
+{0x3208,0x0a},
+{0x3209,0x00},
+{0x320a,0x05},
+{0x320b,0xa0},
+{0x320c,0x0a},
+{0x320d,0x20},
+{0x320e,0x05},
+{0x320f,0xdc},
+{0x3210,0x00},
+{0x3211,0x04},
+{0x3212,0x00},
+{0x3213,0x04},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3248,0x04},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x3301,0x1c},
+{0x3306,0xc8},
+{0x3309,0x40},
+{0x330b,0xc0},
+{0x330e,0x60},
+{0x3314,0x94},
+{0x331f,0x31},
+{0x334c,0x10},
+{0x335d,0x60},
+{0x3364,0x16},
+{0x3366,0x92},
+{0x3367,0x08},
+{0x3368,0x09},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x336c,0xc2},
+{0x337f,0x33},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x33af,0x24},
+{0x33e0,0xa0},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x360f,0x01},
+{0x3622,0xf7},
+{0x3624,0x45},
+{0x3628,0x83},
+{0x3630,0x80},
+{0x3631,0x80},
+{0x3632,0xa8},
+{0x3633,0x22},
+{0x3635,0x02},
+{0x3637,0x29},
+{0x3638,0x08},
+{0x363a,0x88},
+{0x363b,0x06},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x3670,0x4a},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x55},
+{0x3699,0x9f},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x3901,0x00},
+{0x3902,0xc5},
+{0x3904,0x18},
+{0x3905,0xd8},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3980,0x71},
+{0x3981,0x70},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3984,0x20},
+{0x3987,0x0b},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x03},
+{0x3995,0xff},
+{0x3996,0x00},
+{0x3997,0x03},
+{0x3998,0x00},
+{0x3999,0x06},
+{0x399a,0x00},
+{0x399b,0x0e},
+{0x399c,0x00},
+{0x399d,0x10},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xee},
+{0x39a6,0x03},
+{0x39a7,0xf4},
+{0x39a8,0x03},
+{0x39a9,0xf6},
+{0x39aa,0x03},
+{0x39ab,0xfd},
+{0x39ac,0x00},
+{0x39ad,0x04},
+{0x39ae,0x00},
+{0x39af,0x06},
+{0x39b0,0x00},
+{0x39b1,0x0e},
+{0x39b2,0x00},
+{0x39b3,0x1c},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39c5,0x30},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x19},
+{0x39e3,0xe9},
+{0x39e4,0x0e},
+{0x39e5,0x14},
+{0x39e6,0x00},
+{0x39e7,0x23},
+{0x39e8,0x03},
+{0x39e9,0xba},
+{0x39ea,0x02},
+{0x39eb,0x6d},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3e00,0x00},
+{0x3e01,0xba},
+{0x3e02,0xe0},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e0e,0x09},
+{0x3e14,0x31},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e1b,0x3a},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x3e26,0x40},
+{0x3f00,0x4e},
+{0x3f05,0x70},
+{0x4501,0xb4},
+{0x4509,0x20},
+{0x4837,0x22},
+{0x5799,0x06},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3641,0x0c},
+{0x36e9,0x37},
+{0x36ea,0x7d},
+{0x36eb,0x14},
+{0x36ec,0x05},
+{0x36ed,0x14},
+{0x36f9,0x37},
+{0x36fa,0x7d},
+{0x36fb,0x14},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x3641,0x00},
+{0x0100,0x01},
+
+};
+
+
+I2C_ARRAY Sensor_init_table_4lane_2M60fps[] =
+{
+//cleaned_0x29_SC8235_MIPI_27Minput_4lane_10bit_675Mbps_1920x1080_60fps_hbin_vbin_2000x1125.ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x301f,0x29},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x3038,0x44},
+{0x3203,0x08},
+{0x3207,0x87},
+{0x3208,0x07},
+{0x3209,0x80},
+{0x320a,0x04},
+{0x320b,0x38},
+{0x320c,0x07},
+{0x320d,0xd0},
+{0x320e,0x04},
+{0x320f,0x65},
+{0x3211,0x08},
+{0x3213,0x04},
+{0x3214,0x31},
+{0x3215,0x31},
+{0x3220,0x1c},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3248,0x04},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x3301,0x1c},
+{0x3306,0xa0},
+{0x3308,0x20},
+{0x3309,0x68},
+{0x330b,0x38},
+{0x330d,0x28},
+{0x330e,0x58},
+{0x3314,0x94},
+{0x331f,0x59},
+{0x3332,0x24},
+{0x334c,0x10},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x335d,0x60},
+{0x3364,0x16},
+{0x3366,0x92},
+{0x3367,0x08},
+{0x3368,0x07},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x336c,0xc2},
+{0x337f,0x33},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x38},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x38},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x33af,0x48},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x360f,0x01},
+{0x3620,0x48},
+{0x3622,0xf7},
+{0x3624,0x45},
+{0x3628,0x83},
+{0x3630,0x80},
+{0x3631,0x80},
+{0x3632,0xa8},
+{0x3633,0x23},
+{0x3635,0x02},
+{0x3637,0x52},
+{0x3638,0x0a},
+{0x363a,0x88},
+{0x363b,0x06},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x3670,0x4a},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x3699,0x9f},
+{0x369a,0x9f},
+{0x369b,0x9f},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x3901,0x00},
+{0x3902,0xc5},
+{0x3904,0x18},
+{0x3905,0xd8},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3980,0x71},
+{0x3981,0x70},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3984,0x20},
+{0x3987,0x0b},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39c5,0x30},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3e00,0x00},
+{0x3e01,0x8c},
+{0x3e02,0x00},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e0e,0x09},
+{0x3e14,0x31},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e1b,0x3a},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x3e26,0x40},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x450d,0x08},
+{0x4837,0x1c},
+{0x5799,0x06},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3641,0x0c},
+{0x36e9,0x40},
+{0x36ea,0x31},
+{0x36eb,0x06},
+{0x36ec,0x05},
+{0x36ed,0x24},
+{0x36f9,0x44},
+{0x36fa,0x31},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x3641,0x00},
+{0x0100,0x01},
+
+};
+
+I2C_ARRAY Sensor_init_table_HDR_DOL_4lane[] =
+{
+//cleaned_0x23_SC8235_MIPI_27Minput_4lane_10bit_708.75Mbps_3840x2160_hdr(vc)_15fps_4200x4500.ini
+{0x0103,0x01},
+{0x0100,0x00},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x301f,0x23},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x3038,0x44},
+{0x320c,0x08},
+{0x320d,0x34},
+{0x320e,0x11},
+{0x320f,0x94},
+{0x3220,0x50},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3248,0x04},
+{0x3250,0x3f},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x3301,0x1c},
+{0x3306,0xa8},
+{0x3308,0x20},
+{0x3309,0x68},
+{0x330b,0x48},
+{0x330d,0x28},
+{0x330e,0x58},
+{0x3314,0x98},
+{0x331f,0x59},
+{0x3332,0x24},
+{0x334a,0x18},
+{0x334c,0x10},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x335d,0x60},
+{0x3360,0x40},
+{0x3362,0x72},
+{0x3364,0x16},
+{0x3366,0x92},
+{0x3367,0x08},
+{0x3368,0x10},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x336c,0xc2},
+{0x336f,0x58},
+{0x337f,0x33},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x60},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x60},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x33af,0x48},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x360f,0x01},
+{0x3622,0xf7},
+{0x3624,0x45},
+{0x3628,0x83},
+{0x3630,0x80},
+{0x3631,0x80},
+{0x3632,0xa8},
+{0x3633,0x23},
+{0x3635,0x02},
+{0x3636,0x11},
+{0x3637,0x10},
+{0x3638,0x0a},
+{0x363a,0x88},
+{0x363b,0x06},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x3670,0x4a},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x3699,0x88},
+{0x369a,0x88},
+{0x369b,0x88},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x3901,0x00},
+{0x3902,0xc5},
+{0x3904,0x18},
+{0x3905,0xd8},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3980,0x71},
+{0x3981,0x70},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3984,0x20},
+{0x3987,0x0b},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39c5,0x30},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3e00,0x02},
+{0x3e01,0x0f},
+{0x3e02,0xa0},
+{0x3e04,0x20},
+{0x3e05,0xc0},
+{0x3e06,0x00},
+{0x3e07,0x80},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e0e,0x09},
+{0x3e10,0x00},
+{0x3e11,0x80},
+{0x3e12,0x03},
+{0x3e13,0x40},
+{0x3e14,0x31},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e1b,0x3a},
+{0x3e1e,0x76},
+{0x3e23,0x01},
+{0x3e24,0x0e},
+{0x3e25,0x23},
+{0x3e26,0x40},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x4816,0x51},
+{0x4837,0x1c},
+{0x5799,0x06},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3641,0x0c},
+{0x36e9,0x53},
+{0x36ea,0x39},
+{0x36eb,0x06},
+{0x36ec,0x05},
+{0x36ed,0x24},
+{0x36f9,0x57},
+{0x36fa,0x39},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x3641,0x00},
+{0x0100,0x01},
+};
+
+I2C_ARRAY Sensor_init_table_HDR_DOL_4lane_2M[] =
+{
+{0x0103,0x01},
+{0x0100,0x00},
+{0x336c,0xc2},
+{0x3624,0x45},
+{0x33e1,0x08},
+{0x33e2,0x18},
+{0x33e3,0x10},
+{0x33e4,0x0c},
+{0x33e5,0x10},
+{0x33e6,0x06},
+{0x33e7,0x02},
+{0x33e8,0x18},
+{0x33e9,0x10},
+{0x33ea,0x0c},
+{0x33eb,0x10},
+{0x33ec,0x04},
+{0x33ed,0x02},
+{0x33ee,0xa0},
+{0x33ef,0x08},
+{0x33f4,0x18},
+{0x33f5,0x10},
+{0x33f6,0x0c},
+{0x33f7,0x10},
+{0x33f8,0x06},
+{0x33f9,0x02},
+{0x33fa,0x18},
+{0x33fb,0x10},
+{0x33fc,0x0c},
+{0x33fd,0x10},
+{0x33fe,0x04},
+{0x33ff,0x02},
+{0x5799,0x06},
+{0x3e16,0x00},
+{0x3e17,0xac},
+{0x3e18,0x00},
+{0x3e19,0xac},
+{0x3e0e,0x09},
+{0x3e1e,0x76},
+{0x3e25,0x23},
+{0x57aa,0x2f},
+{0x57ab,0xff},
+{0x3018,0x72},
+{0x3019,0x00},
+{0x3031,0x0a},
+{0x3037,0x20},
+{0x4501,0xa4},
+{0x4509,0x10},
+{0x4837,0x1c},
+{0x3366,0x92},
+{0x334c,0x10},
+{0x3631,0x80},
+{0x3308,0x20},
+{0x335d,0x60},
+{0x337f,0x33},
+{0x3369,0x00},
+{0x336a,0x00},
+{0x336b,0x00},
+{0x3367,0x08},
+{0x330e,0x58},
+{0x33af,0x48},
+{0x3638,0x0a},
+{0x3309,0x68},
+{0x331f,0x59},
+{0x330d,0x28},
+{0x339e,0x24},
+{0x33aa,0x24},
+{0x3332,0x24},
+{0x3350,0x24},
+{0x3358,0x24},
+{0x335c,0x24},
+{0x3628,0x83},
+{0x3633,0x23},
+{0x3630,0x80},
+{0x3622,0xf7},
+{0x363d,0x01},
+{0x363e,0x00},
+{0x363a,0x88},
+{0x3e26,0x40},
+{0x360f,0x01},
+{0x367a,0x48},
+{0x367b,0x78},
+{0x3671,0xf7},
+{0x3672,0xf7},
+{0x3673,0x17},
+{0x3670,0x4a},
+{0x367c,0x48},
+{0x367d,0x78},
+{0x3674,0x80},
+{0x3675,0x85},
+{0x3676,0xa5},
+{0x369c,0x48},
+{0x369d,0x78},
+{0x3690,0x53},
+{0x3691,0x63},
+{0x3692,0x54},
+{0x36a2,0x48},
+{0x36a3,0x78},
+{0x3699,0x88},
+{0x36bb,0x48},
+{0x36bc,0x78},
+{0x36c9,0x05},
+{0x36ca,0x05},
+{0x36cb,0x05},
+{0x36d0,0x30},
+{0x36d1,0x48},
+{0x36d2,0x78},
+{0x36cc,0x00},
+{0x36cd,0x10},
+{0x36ce,0x1a},
+{0x3364,0x16},
+{0x3301,0x1c},
+{0x3393,0x1c},
+{0x3394,0x28},
+{0x3395,0x38},
+{0x3390,0x08},
+{0x3391,0x18},
+{0x3392,0x38},
+{0x3399,0x1c},
+{0x339a,0x1c},
+{0x339b,0x28},
+{0x339c,0x38},
+{0x3396,0x08},
+{0x3397,0x18},
+{0x3398,0x38},
+{0x3241,0x00},
+{0x3243,0x03},
+{0x3271,0x1c},
+{0x3273,0x1f},
+{0x394c,0x0f},
+{0x394d,0x20},
+{0x394e,0x08},
+{0x394f,0x90},
+{0x3981,0x70},
+{0x3984,0x20},
+{0x39ec,0x08},
+{0x39ed,0x00},
+{0x3982,0x00},
+{0x3983,0x00},
+{0x3980,0x71},
+{0x39b4,0x0c},
+{0x39b5,0x1c},
+{0x39b6,0x38},
+{0x39b7,0x5b},
+{0x39b8,0x50},
+{0x39b9,0x38},
+{0x39ba,0x20},
+{0x39bb,0x10},
+{0x39bc,0x0c},
+{0x39bd,0x16},
+{0x39be,0x21},
+{0x39bf,0x36},
+{0x39c0,0x3b},
+{0x39c1,0x2a},
+{0x39c2,0x16},
+{0x39c3,0x0c},
+{0x39a2,0x03},
+{0x39a3,0xe3},
+{0x39a4,0x03},
+{0x39a5,0xf2},
+{0x39a6,0x03},
+{0x39a7,0xf6},
+{0x39a8,0x03},
+{0x39a9,0xfa},
+{0x39aa,0x03},
+{0x39ab,0xff},
+{0x39ac,0x00},
+{0x39ad,0x06},
+{0x39ae,0x00},
+{0x39af,0x09},
+{0x39b0,0x00},
+{0x39b1,0x12},
+{0x39b2,0x00},
+{0x39b3,0x22},
+{0x39c6,0x07},
+{0x39c7,0xf8},
+{0x39c9,0x07},
+{0x39ca,0xf8},
+{0x3990,0x03},
+{0x3991,0xfd},
+{0x3992,0x03},
+{0x3993,0xfc},
+{0x3994,0x00},
+{0x3995,0x00},
+{0x3996,0x00},
+{0x3997,0x05},
+{0x3998,0x00},
+{0x3999,0x09},
+{0x399a,0x00},
+{0x399b,0x12},
+{0x399c,0x00},
+{0x399d,0x12},
+{0x399e,0x00},
+{0x399f,0x18},
+{0x39a0,0x00},
+{0x39a1,0x14},
+{0x39cc,0x00},
+{0x39cd,0x1b},
+{0x39ce,0x00},
+{0x39cf,0x00},
+{0x39d0,0x1b},
+{0x39d1,0x00},
+{0x39e2,0x15},
+{0x39e3,0x87},
+{0x39e4,0x12},
+{0x39e5,0xb7},
+{0x39e6,0x00},
+{0x39e7,0x8c},
+{0x39e8,0x01},
+{0x39e9,0x31},
+{0x39ea,0x01},
+{0x39eb,0xd7},
+{0x39c5,0x30},
+{0x3214,0x31},
+{0x3620,0x48},
+{0x3208,0x07},
+{0x3209,0x80},
+{0x3211,0x08},
+{0x450d,0x08},
+{0x3215,0x31},
+{0x320a,0x04},
+{0x320b,0x38},
+{0x3641,0x00},
+{0x3635,0x02},
+{0x3902,0xc5},
+{0x3038,0x44},
+{0x3e14,0x31},
+{0x3e1b,0x3a},
+{0x3248,0x04},
+{0x3901,0x00},
+{0x3904,0x18},
+{0x3987,0x0b},
+{0x363b,0x06},
+{0x3905,0xd8},
+{0x301f,0x29},
+{0x320c,0x07},
+{0x320d,0xd0},
+{0x3641,0x0c},
+{0x36f9,0x44},
+{0x36fa,0x31},
+{0x36fb,0x13},
+{0x36fc,0x10},
+{0x36fd,0x14},
+{0x36e9,0x40},
+{0x36ea,0x31},
+{0x36eb,0x06},
+{0x36ec,0x05},
+{0x36ed,0x24},
+{0x3641,0x00},
+{0x3306,0xa0},
+{0x330b,0x38},
+{0x3203,0x08},
+{0x3207,0x87},
+{0x3213,0x04},
+{0x3802,0x01},
+{0x3220,0x5c},
+{0x336f,0x58},
+{0x4816,0x51},
+{0x3250,0x3f},
+{0x320e,0x08},
+{0x320f,0xca},
+{0x3e23,0x00},
+{0x3e24,0x8c},
+{0x3314,0x98},
+{0x334a,0x18},
+{0x3636,0x11},
+{0x3637,0x10},
+{0x3e00,0x01},
+{0x3e01,0x06},
+{0x3e02,0xc0},
+{0x3e04,0x10},
+{0x3e05,0x60},
+{0x3e06,0x00},
+{0x3e07,0x80},
+{0x3e08,0x03},
+{0x3e09,0x40},
+{0x3e10,0x00},
+{0x3e11,0x80},
+{0x3e12,0x03},
+{0x3e13,0x40},
+{0x3362,0x72},
+{0x3360,0x40},
+{0x3368,0x0e},
+{0x369a,0x88},
+{0x369b,0x88},
+{0x3632,0xa8},//2020/06/11
+{0x0100,0x01},
+};
+
+
+I2C_ARRAY TriggerStartTbl[] = {
+//{0x30f4,0x00},//Master mode start
+};
+
+I2C_ARRAY PatternTbl[] = {
+    //pattern mode
+};
+
+I2C_ARRAY mirror_reg[] =
+{
+    {0x3221, 0x00}, // mirror[2:1], flip[6:5]
+};
+
+I2C_ARRAY mirror_reg_HDR[] =
+{
+    {0x3221, 0x00}, // mirror[2:1], flip[6:5]
+    {0x3812, 0x00},
+    {0x4505, 0x80},
+    {0x3812, 0x30},
+};
+
+typedef struct {
+    short reg;
+    char startbit;
+    char stopbit;
+} COLLECT_REG_SET;
+
+static I2C_ARRAY gain_reg[] = {
+    {0x3e06, 0x00},
+    {0x3e07, 0x00},
+    {0x3e08, 0x00|0x03},
+    {0x3e09, 0x40}, //low bit, 0x40 - 0x7f, step 1/64
+
+};
+static I2C_ARRAY gain_reg_HDR_DOL_SEF[] = {
+    {0x3e10, 0x00},
+    {0x3e11, 0x00},
+    {0x3e12, 0x00|0x03},
+    {0x3e13, 0x10}, //low bit, 0x40 - 0x7f, step 1/64
+    };
+
+I2C_ARRAY expo_reg[] = {
+    {0x3e00, 0x00}, //expo [3:0]
+    {0x3e01, 0x30}, // expo[7:0]
+    {0x3e02, 0x00}, // expo[7:4]
+};
+I2C_ARRAY expo_reg_HDR_DOL_SEF[] = {
+    {0x3e04, 0x21}, // expo[7:0]
+    {0x3e05, 0x00}, // expo[7:4]
+};
+
+I2C_ARRAY vts_reg[] = {
+    {0x320e, 0x08},
+    {0x320f, 0xca}
+};
+I2C_ARRAY max_short_exp_reg[] = {
+    {0x3e23, 0x01},
+    {0x3e24, 0x0e}
+};
+
+#if 0
+CUS_INT_TASK_ORDER def_order = {
+        .RunLength = 9,
+        .Orders = {
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AE|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_AWB|CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+                CUS_INT_TASK_VDOS|CUS_INT_TASK_AF,
+        },
+};
+#endif
+
+/////////// function definition ///////////////////
+#if SENSOR_DBG == 1
+//#define SENSOR_DMSG(args...) SENSOR_DMSG(args)
+//#define SENSOR_DMSG(args...) LOGE(args)
+#define SENSOR_DMSG(args...) SENSOR_DMSG(args)
+#elif SENSOR_DBG == 0
+//#define SENSOR_DMSG(args...)
+#endif
+#undef SENSOR_NAME
+#define SENSOR_NAME sc8238
+
+#define SensorReg_Read(_reg,_data)     (handle->i2c_bus->i2c_rx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorReg_Write(_reg,_data)    (handle->i2c_bus->i2c_tx(handle->i2c_bus, &(handle->i2c_cfg),_reg,_data))
+#define SensorRegArrayW(_reg,_len)  (handle->i2c_bus->i2c_array_tx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+#define SensorRegArrayR(_reg,_len)  (handle->i2c_bus->i2c_array_rx(handle->i2c_bus, &(handle->i2c_cfg),(_reg),(_len)))
+
+/////////////////// sensor hardware dependent //////////////
+#if 0
+static int ISP_config_io(ms_cus_sensor *handle) {
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+
+    sensor_if->HsyncPol(handle, handle->HSYNC_POLARITY);
+    sensor_if->VsyncPol(handle, handle->VSYNC_POLARITY);
+    sensor_if->ClkPol(handle, handle->PCLK_POLARITY);
+    sensor_if->BayerFmt(handle, handle->bayer_id);
+    sensor_if->DataBus(handle, handle->sif_bus);
+
+    sensor_if->DataPrecision(handle, handle->data_prec);
+    sensor_if->FmtConv(handle,  handle->data_mode);
+    return SUCCESS;
+}
+#endif
+static int pCus_poweron(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    //Sensor power on sequence
+    sensor_if->MCLK(idx, 1, handle->mclk);
+
+    sensor_if->SetIOPad(idx, handle->sif_bus, handle->interface_attr.attr_mipi.mipi_lane_num);
+/*     sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_DCG) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 2);
+    } */
+
+    SENSOR_DMSG("[%s] reset low\n", __FUNCTION__);
+    sensor_if->Reset(idx, handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+    SENSOR_DMSG("[%s] power low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    SENSOR_USLEEP(1000);
+
+    // power -> high, reset -> high
+    SENSOR_DMSG("[%s] power high\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    SENSOR_USLEEP(1000);
+    SENSOR_DMSG("[%s] reset high\n", __FUNCTION__);
+    sensor_if->Reset(idx, !handle->reset_POLARITY);
+    SENSOR_USLEEP(1000);
+
+    //sensor_if->Set3ATaskOrder(handle, def_order);
+    // pure power on
+    //ISP_config_io(handle);
+    sensor_if->PowerOff(idx, !handle->pwdn_POLARITY);
+    SENSOR_USLEEP(5000);
+    //handle->i2c_bus->i2c_open(handle->i2c_bus,&handle->i2c_cfg);
+
+    return SUCCESS;
+}
+
+static int pCus_post_init(ms_cus_sensor *handle, u32 idx)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    SENSOR_DMSG("[%s] ", __FUNCTION__);
+
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_216M);
+    sensor_if->SetCSI_Lane(idx, handle->interface_attr.attr_mipi.mipi_lane_num, 1);
+    sensor_if->SetCSI_LongPacketType(idx, 0, 0x1C00, 0);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_DCG) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 2);
+    }
+    return SUCCESS;
+}
+
+static int pCus_poweroff(ms_cus_sensor *handle, u32 idx)
+{
+    // power/reset low
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    SENSOR_DMSG("[%s] power low\n", __FUNCTION__);
+    sensor_if->PowerOff(idx, handle->pwdn_POLARITY);
+    //handle->i2c_bus->i2c_close(handle->i2c_bus);
+    SENSOR_USLEEP(1000);
+    //Set_csi_if(0, 0);
+    sensor_if->SetCSI_Clk(idx, CUS_CSI_CLK_DISABLE);
+    if (handle->interface_attr.attr_mipi.mipi_hdr_mode == CUS_HDR_MODE_DCG) {
+        sensor_if->SetCSI_hdr_mode(idx, handle->interface_attr.attr_mipi.mipi_hdr_mode, 0);
+    }
+    sensor_if->MCLK(idx, 0, handle->mclk);
+
+    params->cur_orien = CUS_ORIT_M0F0;
+
+    SENSOR_USLEEP(2000);//mantis:1690203
+    return SUCCESS;
+}
+
+/////////////////// image function /////////////////////////
+//Get and check sensor ID
+//if i2c error or sensor id does not match then return FAIL
+static int pCus_GetSensorID(ms_cus_sensor *handle, u32 *id)
+{
+    int i,n;
+    int table_length= ARRAY_SIZE(Sensor_id_table);
+    I2C_ARRAY id_from_sensor[ARRAY_SIZE(Sensor_id_table)];
+
+    SensorReg_Write(0xef,0x00);
+
+    for(n=0;n<table_length;++n)
+    {
+      id_from_sensor[n].reg = Sensor_id_table[n].reg;
+      id_from_sensor[n].data = 0;
+    }
+
+    *id =0;
+    if(table_length>8) table_length=8;
+
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+
+    for(n=0;n<4;++n) //retry , until I2C success
+    {
+      if(n>2) return FAIL;
+
+      if( SensorRegArrayR((I2C_ARRAY*)id_from_sensor,table_length) == SUCCESS) //read sensor ID from I2C
+          break;
+      else
+          continue;
+    }
+
+    //convert sensor id to u32 format
+    for(i=0;i<table_length;++i)
+    {
+      if( id_from_sensor[i].data != Sensor_id_table[i].data )
+        return FAIL;
+      //*id = id_from_sensor[i].data;
+      *id = ((*id)+ id_from_sensor[i].data)<<8;
+    }
+
+    *id >>= 8;
+    SENSOR_DMSG("[%s]sc8238 Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+    //SENSOR_DMSG("[%s]Read sensor id, get 0x%x Success\n", __FUNCTION__, (int)*id);
+
+    return SUCCESS;
+}
+
+static int sc8238_SetPatternMode(ms_cus_sensor *handle,u32 mode)
+{
+
+    SENSOR_DMSG("\n\n[%s], mode=%d \n", __FUNCTION__, mode);
+
+    return SUCCESS;
+}
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps);
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain);
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status);
+
+static int pCus_init_mipi4lane_linear_4K30fps(ms_cus_sensor *handle)
+{
+    short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4K30fps);i++)
+    {
+        if(Sensor_init_table_4lane_4K30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4K30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4K30fps[i].reg, Sensor_init_table_4lane_4K30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    pr_info("[%s]  vts_reg_sef : %x , %x\n\n", __FUNCTION__,vts_reg[0].data,vts_reg[1].data);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_4K20fps(ms_cus_sensor *handle)
+{
+    short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4K20fps);i++)
+    {
+        if(Sensor_init_table_4lane_4K20fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4K20fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4K20fps[i].reg, Sensor_init_table_4lane_4K20fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+    //BL control
+    //SensorReg_Write(0x3907,0x01);
+    //SensorReg_Write(0x3908,0x11);
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    pr_info("[%s]  vts_reg_sef : %x , %x\n\n", __FUNCTION__,vts_reg[0].data,vts_reg[1].data);
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_4K15fps(ms_cus_sensor *handle)
+{
+   // short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4K15fps);i++)
+    {
+        if(Sensor_init_table_4lane_4K15fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4K15fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4K15fps[i].reg, Sensor_init_table_4lane_4K15fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+#if 0
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+#endif
+    //BL control
+  //  SensorReg_Write(0x3907,0x01);
+  //  SensorReg_Write(0x3908,0x11);
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_5M30fps(ms_cus_sensor *handle)
+{
+  //  short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_5M30fps);i++)
+    {
+        if(Sensor_init_table_4lane_5M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_5M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_5M30fps[i].reg, Sensor_init_table_4lane_5M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+#if 0
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+#endif
+    //BL control
+   // SensorReg_Write(0x3907,0x01);
+  //  SensorReg_Write(0x3908,0x11);
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+////////
+static int pCus_init_mipi4lane_linear_5MP3_30fps(ms_cus_sensor *handle)
+{
+  //  short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_5MP3_30fps);i++)
+    {
+        if(Sensor_init_table_4lane_5MP3_30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_5MP3_30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_5MP3_30fps[i].reg, Sensor_init_table_4lane_5MP3_30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+#if 0
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+#endif
+    //BL control
+   // SensorReg_Write(0x3907,0x01);
+  //  SensorReg_Write(0x3908,0x11);
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+
+
+
+static int pCus_init_mipi4lane_linear_4P8M30fps(ms_cus_sensor *handle)
+{
+   // short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_4P8M30fps);i++)
+    {
+        if(Sensor_init_table_4lane_4P8M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_4P8M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_4P8M30fps[i].reg, Sensor_init_table_4lane_4P8M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+#if 0
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+#endif
+    //BL control
+ //   SensorReg_Write(0x3907,0x01);
+  //  SensorReg_Write(0x3908,0x11);
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_linear_3P6M30fps(ms_cus_sensor *handle)
+{
+   // short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_3P6M30fps);i++)
+    {
+        if(Sensor_init_table_4lane_3P6M30fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_3P6M30fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_3P6M30fps[i].reg, Sensor_init_table_4lane_3P6M30fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+#if 0
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+#endif
+    //BL control
+   // SensorReg_Write(0x3907,0x01);
+  //  SensorReg_Write(0x3908,0x11);
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+static int pCus_init_mipi4lane_linear_2M60fps(ms_cus_sensor *handle)
+{
+  //  short ver=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    //SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    int i,cnt;
+    //ISensorIfAPI *sensor_if = &(handle->sensor_if_api);
+    //sensor_if->PCLK(NULL,CUS_PCLK_MIPI_TOP);
+
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_4lane_2M60fps);i++)
+    {
+        if(Sensor_init_table_4lane_2M60fps[i].reg==0xffff)
+        {
+            SENSOR_MSLEEP(Sensor_init_table_4lane_2M60fps[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            while(SensorReg_Write(Sensor_init_table_4lane_2M60fps[i].reg, Sensor_init_table_4lane_2M60fps[i].data) != SUCCESS)
+            {
+                cnt++;
+                SENSOR_DMSG("Sensor_init_table -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    SENSOR_DMSG("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                SENSOR_MSLEEP(10);
+            }
+        }
+    }
+#if 0
+    SensorReg_Read(0x3040,&ver);
+    if(ver == 0){
+        SensorReg_Write(0x36c9,0x01);
+        SensorReg_Write(0x36ca,0x00);
+        SensorReg_Write(0x36cb,0x00);
+    }else if(ver == 1){
+        SensorReg_Write(0x36c9,0x05);
+        SensorReg_Write(0x36ca,0x05);
+        SensorReg_Write(0x36cb,0x05);
+    }
+#endif
+    //BL control
+ //   SensorReg_Write(0x3907,0x01);
+  //  SensorReg_Write(0x3908,0x11);
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+    pCus_SetOrien(handle, params->cur_orien);
+   // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+    vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+    vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+    // usleep(50*1000);
+    //pCus_SetAEGain(handle,1024);
+    //pCus_SetAEUSecs(handle, 40000);
+    //pCus_AEStatusNotify(handle,CUS_FRAME_ACTIVE);
+    return SUCCESS;
+}
+
+
+static int pCus_init_mipi4lane_HDR_DOL(ms_cus_sensor *handle)
+{
+  //  short ver=0;
+   sc8238_params *params = (sc8238_params *)handle->private_data;
+    int i,cnt=0;
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane[i].reg==0xffff)
+        {
+            //MsSleep(RTK_MS_TO_TICK(1));//usleep(1000*Sensor_init_table_HDR_DOL_4lane[i].data);
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            SENSOR_DMSG("reg =  %x, data = %x\n", Sensor_init_table_HDR_DOL_4lane[i].reg, Sensor_init_table_HDR_DOL_4lane[i].data);
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane[i].reg,Sensor_init_table_HDR_DOL_4lane[i].data) != SUCCESS)
+            {
+                cnt++;
+                 SENSOR_DMSG("Sensor_init_table_HDR_DOL_4lane -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+            //SensorReg_Read( Sensor_init_table_HDR_DOL_4lane[i].reg, &sen_data );
+            //UartSendTrace("sc8238 reg: 0x%x, data: 0x%x, read: 0x%x.\n",Sensor_init_table_HDR_DOL_4lane[i].reg, Sensor_init_table_HDR_DOL_4lane[i].data, sen_data);
+        }
+    }
+
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+     pCus_SetOrien_HDR(handle, params->cur_orien);
+    // pr_info("cur_orien %s pCus_SetOrien %x\n",__FUNCTION__, params->cur_orien);
+     vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+     vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+static int pCus_init_mipi4lane_HDR_DOL_2M(ms_cus_sensor *handle)
+{
+  //  short ver=0;
+   sc8238_params *params = (sc8238_params *)handle->private_data;
+    int i,cnt=0;
+    for(i=0;i< ARRAY_SIZE(Sensor_init_table_HDR_DOL_4lane_2M);i++)
+    {
+        if(Sensor_init_table_HDR_DOL_4lane_2M[i].reg==0xffff)
+        {
+            //MsSleep(RTK_MS_TO_TICK(1));//usleep(1000*Sensor_init_table_HDR_DOL_4lane_2M[i].data);
+            SENSOR_MSLEEP(Sensor_init_table_HDR_DOL_4lane_2M[i].data);
+        }
+        else
+        {
+            cnt = 0;
+            SENSOR_DMSG("reg =  %x, data = %x\n", Sensor_init_table_HDR_DOL_4lane_2M[i].reg, Sensor_init_table_HDR_DOL_4lane_2M[i].data);
+            while(SensorReg_Write(Sensor_init_table_HDR_DOL_4lane_2M[i].reg,Sensor_init_table_HDR_DOL_4lane_2M[i].data) != SUCCESS)
+            {
+                cnt++;
+                 SENSOR_DMSG("Sensor_init_table_HDR_DOL_4lane_2M -> Retry %d...\n",cnt);
+                if(cnt>=10)
+                {
+                    //printf("[%s:%d]Sensor init fail!!\n", __FUNCTION__, __LINE__);
+                    return FAIL;
+                }
+                //usleep(10*1000);
+            }
+        }
+    }
+    //DPC patch
+    SensorReg_Write(0x5780,0x57);
+    SensorReg_Write(0x5785,0x00);
+    SensorReg_Write(0x5786,0x00);
+    SensorReg_Write(0x5799,0x07); //20190710
+
+     pCus_SetOrien_HDR(handle, params->cur_orien);
+     vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+     vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+
+    return SUCCESS;
+}
+
+
+/*
+int pCus_release(ms_cus_sensor *handle)
+{
+    ISensorIfAPI *sensor_if = handle->sensor_if_api;
+    sensor_if->PCLK(NULL,CUS_PCLK_OFF);
+    return SUCCESS;
+}
+*/
+
+static int pCus_GetVideoResNum( ms_cus_sensor *handle, u32 *ulres_num)
+{
+    *ulres_num = handle->video_res_supported.num_res;
+    return SUCCESS;
+}
+
+static int pCus_GetVideoRes(ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[res_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_GetCurVideoRes(ms_cus_sensor *handle, u32 *cur_idx, cus_camsensor_res **res)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+
+    *cur_idx = handle->video_res_supported.ulcur_res;
+
+    if (*cur_idx >= num_res) {
+        return FAIL;
+    }
+
+    *res = &handle->video_res_supported.res[*cur_idx];
+
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+
+        case 0: //"3840x2160@15fps"
+            handle->video_res_supported.ulcur_res = 0;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4K15fps;
+            vts_30fps=2250;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 15;
+            Preview_line_period  = 29630;
+            break;
+        case 1: //"3840x2160@20fps"
+            handle->video_res_supported.ulcur_res = 1;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4K20fps;
+            vts_30fps=2250;//3375
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 20;
+            Preview_line_period  = 22222;///14815
+            break;
+		case 2: //"3072x1728@30fps"
+            handle->video_res_supported.ulcur_res = 2;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_5MP3_30fps;
+            vts_30fps=2250;//3375
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 14815;///14815
+            break;			
+        case 3: //"2592x1944@30fps"
+            handle->video_res_supported.ulcur_res = 3;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_5M30fps;
+            vts_30fps=2250;//3375
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 14815;///14815
+            break;
+        case 4: //"2944x1656@30fps"
+            handle->video_res_supported.ulcur_res = 4;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4P8M30fps;
+            vts_30fps=2250;//3375
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 14815;///14815
+            break;
+        case 5: //"2560x1440@30fps"
+            handle->video_res_supported.ulcur_res = 5;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_3P6M30fps;
+            vts_30fps=1500;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 22222;
+            break;
+       case 6: //"1920x1080@60fps"
+            handle->video_res_supported.ulcur_res = 6;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_2M60fps;
+            vts_30fps=1125;
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 60;
+            Preview_line_period  = 14815;
+            break;
+        case 7: //"3840x2160@30fps"
+            handle->video_res_supported.ulcur_res = 7;
+            handle->pCus_sensor_init = pCus_init_mipi4lane_linear_4K30fps;
+            vts_30fps=2250;//3375
+            params->expo.vts = vts_30fps;
+            params->expo.fps = 30;
+            Preview_line_period  = 14815;///14815
+            break;
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+static int pCus_SetVideoRes_HDR_DOL(ms_cus_sensor *handle, u32 res_idx)
+{
+    u32 num_res = handle->video_res_supported.num_res;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+
+    if (res_idx >= num_res) {
+        return FAIL;
+    }
+    switch (res_idx) {
+        case 0:
+            handle->video_res_supported.ulcur_res = 0;
+            if (handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num == 1) {
+            handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL;
+            }
+            vts_30fps_HDR_DOL = 4500;//3375
+            Preview_line_period_HDR_DOL  = 14815;///14815
+            params->expo.vts = vts_30fps_HDR_DOL;
+            params->expo.fps = 15;
+            params->expo.max_short_exp=260;
+            break;
+        case 1:
+            handle->video_res_supported.ulcur_res = 1;
+            if (handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num == 1) {
+            handle->pCus_sensor_init = pCus_init_mipi4lane_HDR_DOL_2M;
+            }
+            vts_30fps_HDR_DOL = 2250;//3375
+            Preview_line_period_HDR_DOL  = 14815;///14815
+            params->expo.vts = vts_30fps_HDR_DOL;
+            params->expo.fps = 15;
+            params->expo.max_short_exp=130;
+            break;
+        default:
+            break;
+    }
+
+    return SUCCESS;
+}
+
+static int pCus_GetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit) {
+    char sen_data;
+    sen_data = mirror_reg[0].data;
+    SENSOR_DMSG("mirror:%x\r\n", sen_data);
+    switch(sen_data) {
+      case 0x00:
+        *orit = CUS_ORIT_M0F0;
+        break;
+      case 0x06:
+        *orit = CUS_ORIT_M1F0;
+        break;
+      case 0x60:
+        *orit = CUS_ORIT_M0F1;
+        break;
+      case 0x66:
+        *orit = CUS_ORIT_M1F1;
+        break;
+      }
+      return SUCCESS;
+}
+
+static int pCus_SetOrien(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+   sc8238_params *params = (sc8238_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            mirror_reg[0].data = 0x00;
+            params->cur_orien = CUS_ORIT_M0F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F0:
+            mirror_reg[0].data = 0x06;
+            params->cur_orien = CUS_ORIT_M1F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M0F1:
+            mirror_reg[0].data = 0x60;
+            params->cur_orien = CUS_ORIT_M0F1;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F1:
+            mirror_reg[0].data = 0x66;
+            params->cur_orien = CUS_ORIT_M1F1;
+            params->reg_mf = true;
+            break;
+        default :
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetOrien_HDR(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+   sc8238_params *params = (sc8238_params *)handle->private_data;
+    SENSOR_DMSG("\n\n[%s]", __FUNCTION__);
+    switch(orit)
+    {
+        case CUS_ORIT_M0F0:
+            mirror_reg_HDR[0].data = 0x00;
+            mirror_reg_HDR[2].data = 0x80;
+            params->cur_orien = CUS_ORIT_M0F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F0:
+            mirror_reg_HDR[0].data = 0x06;
+            mirror_reg_HDR[2].data = 0x83;
+            params->cur_orien = CUS_ORIT_M1F0;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M0F1:
+            mirror_reg_HDR[0].data = 0x60;
+            mirror_reg_HDR[2].data = 0x80;
+            params->cur_orien = CUS_ORIT_M0F1;
+            params->reg_mf = true;
+            break;
+        case CUS_ORIT_M1F1:
+            mirror_reg_HDR[0].data = 0x66;
+            mirror_reg_HDR[2].data = 0x83;
+            params->cur_orien = CUS_ORIT_M1F1;
+            params->reg_mf = true;
+            break;
+        default :
+            break;
+    }
+    return SUCCESS;
+}
+
+static int pCus_GetFPS(ms_cus_sensor *handle)
+{
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (vts_reg[0].data << 8) | (vts_reg[1].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS(ms_cus_sensor *handle, u32 fps)
+{
+    u32 vts=0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+    pr_info("[%s]  max_min_fps : %d ,%d\n\n", __FUNCTION__,max_fps,min_fps);
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*max_fps)/fps;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  (vts_30fps*(max_fps*1000))/fps;
+    }else{
+        SENSOR_DMSG("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+    if(params->expo.line > 2* (params->expo.vts) -10){
+        vts = (params->expo.line + 11)/2;
+    }else{
+        vts = params->expo.vts;
+    }
+    vts_reg[0].data = (vts >> 8) & 0x00ff;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+    params->reg_dirty = true;
+    return SUCCESS;
+
+}
+
+static int pCus_GetFPS_HDR_DOL_SEF(ms_cus_sensor *handle)
+{
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (vts_reg[0].data << 8) | (vts_reg[1].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_SetFPS_HDR_DOL_SEF(ms_cus_sensor *handle, u32 fps)
+{
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+    //pr_info("[%s]  max_min_fps : %d ,%d\n\n", __FUNCTION__,max_fps,min_fps);
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  ((vts_30fps_HDR_DOL*max_fps)/fps >> 1) << 1;
+        vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+        vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+        params->reg_dirty = true;
+        pr_info("[%s]  vts_reg_sef : %x , %x\n\n", __FUNCTION__,vts_reg[0].data,vts_reg[1].data);
+        return SUCCESS;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  ((vts_30fps_HDR_DOL*(max_fps*1000))/fps >> 1) << 1;
+        vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+        vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+        params->reg_dirty = true;
+        pr_info("[%s]  vts_reg_sef : %x , %x\n\n", __FUNCTION__,vts_reg[0].data,vts_reg[1].data);
+        return SUCCESS;
+    }else{
+        pr_info("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+}
+static int pCus_SetFPS_hdr_dol_lef(ms_cus_sensor *handle, u32 fps)
+{
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 min_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].min_fps;
+//  pr_info("[%s]  max_min_fps : %d ,%d\n\n", __FUNCTION__,max_fps,min_fps);
+
+    if(fps>=min_fps && fps <= max_fps){
+        params->expo.fps = fps;
+        params->expo.vts=  ((vts_30fps_HDR_DOL*max_fps)/fps >> 1) << 1;
+        vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+        vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+        params->reg_dirty = true;
+        pr_info("[%s]  vts_reg_lef : %x , %x\n\n", __FUNCTION__,vts_reg[0].data,vts_reg[1].data);
+        return SUCCESS;
+    }else if((fps >= (min_fps*1000)) && (fps <= (max_fps*1000))){
+        params->expo.fps = fps;
+        params->expo.vts=  ((vts_30fps_HDR_DOL*(max_fps*1000))/fps >> 1) << 1;
+        vts_reg[0].data = (params->expo.vts >> 8) & 0x00ff;
+        vts_reg[1].data = (params->expo.vts >> 0) & 0x00ff;
+        params->reg_dirty = true;
+        pr_info("[%s]  vts_reg_lef : %x , %x\n\n", __FUNCTION__,vts_reg[0].data,vts_reg[1].data);
+        return SUCCESS;
+    }else{
+        pr_info("[%s] FPS %d out of range.\n",__FUNCTION__,fps);
+        return FAIL;
+    }
+
+}
+
+
+#if 0
+static int pCus_GetSensorCap(ms_cus_sensor *handle, CUS_CAMSENSOR_CAP *cap) {
+    if (cap)
+        memcpy(cap, &sensor_cap, sizeof(CUS_CAMSENSOR_CAP));
+    else     return FAIL;
+    return SUCCESS;
+}
+#endif
+
+///////////////////////////////////////////////////////////////////////
+// auto exposure
+///////////////////////////////////////////////////////////////////////
+// unit: micro seconds
+//AE status notification
+static int pCus_AEStatusNotify(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status){
+
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+        break;
+        case CUS_FRAME_ACTIVE:
+        if(params->reg_mf)
+        {
+            SensorRegArrayW((I2C_ARRAY*)mirror_reg, ARRAY_SIZE(mirror_reg));
+            params->reg_mf = false;
+        }
+        if(params->reg_dirty)
+        {
+            SensorRegArrayW((I2C_ARRAY*)expo_reg, ARRAY_SIZE(expo_reg));
+            SensorRegArrayW((I2C_ARRAY*)gain_reg, ARRAY_SIZE(gain_reg));
+            SensorRegArrayW((I2C_ARRAY*)vts_reg, ARRAY_SIZE(vts_reg));
+            params->reg_dirty = false;
+        }
+        break;
+        default :
+        break;
+    }
+    return SUCCESS;
+}
+static int pCus_AEStatusNotifyHDR_DOL_LEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+    //sc8238_params *params = (sc8238_params *)handle->private_data;
+
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+        break;
+        case CUS_FRAME_ACTIVE:
+        break;
+        default :
+        break;
+    }
+    return SUCCESS;
+
+}
+
+static int pCus_AEStatusNotifyHDR_DOL_SEF(ms_cus_sensor *handle, CUS_CAMSENSOR_AE_STATUS_NOTIFY status)
+{
+   sc8238_params *params = (sc8238_params *)handle->private_data;
+    switch(status)
+    {
+        case CUS_FRAME_INACTIVE:
+             //SensorReg_Write(0x3001,0);
+
+             break;
+        case CUS_FRAME_ACTIVE:
+        if(params->reg_mf)
+        {
+            SensorRegArrayW((I2C_ARRAY*)mirror_reg_HDR, ARRAY_SIZE(mirror_reg_HDR));
+            params->reg_mf = false;
+        }
+       if(params->reg_dirty)
+        {
+           SensorRegArrayW((I2C_ARRAY*)expo_reg, ARRAY_SIZE(expo_reg));
+           SensorRegArrayW((I2C_ARRAY*)gain_reg, ARRAY_SIZE(gain_reg));
+           SensorRegArrayW((I2C_ARRAY*)expo_reg_HDR_DOL_SEF, ARRAY_SIZE(expo_reg_HDR_DOL_SEF));
+           SensorRegArrayW((I2C_ARRAY*)gain_reg_HDR_DOL_SEF, ARRAY_SIZE(gain_reg_HDR_DOL_SEF));
+           SensorRegArrayW((I2C_ARRAY*)vts_reg, ARRAY_SIZE(vts_reg));
+           params->reg_dirty = false;
+        }
+        break;
+        default :
+             break;
+    }
+    return SUCCESS;
+}
+static int pCus_SetAEUSecsHDR_DOL_LEF(ms_cus_sensor *handle, u32 us)
+{
+    int i;
+    u32 half_lines = 0,dou_lines = 0,vts = 0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    I2C_ARRAY expo_reg_temp[] = {  // max expo line vts-4!
+    {0x3e00, 0x00},//expo [20:17]
+    {0x3e01, 0x00}, // expo[16:8]
+    {0x3e02, 0x10}, // expo[7:0], [3:0] fraction of line
+    };
+    memcpy(expo_reg_temp, expo_reg, sizeof(expo_reg));
+    dou_lines = (1000*us)/(Preview_line_period_HDR_DOL*2); // Preview_line_period in ns
+    half_lines = 4*dou_lines;
+    if(half_lines<8) half_lines=8;
+    if (half_lines >  2 * (params->expo.vts-params->expo.max_short_exp-10)) {
+        half_lines = 2 * (params->expo.vts-params->expo.max_short_exp-10);
+    }
+    else
+     vts=params->expo.vts;
+//  SENSOR_DMSG("[%s] us %ld, half_lines %ld, vts %ld\n", __FUNCTION__, us, half_lines, params->expo.vts);
+
+    half_lines = half_lines<<4;
+
+    expo_reg[0].data = (half_lines>>16) & 0x0f;
+    expo_reg[1].data =  (half_lines>>8) & 0xff;
+    expo_reg[2].data = (half_lines>>0) & 0xf0;
+ //   pr_info("[%s]  expo_reg : %x ,%x , %x\n\n", __FUNCTION__,expo_reg[0].data,expo_reg[1].data,expo_reg[2].data);
+    for (i = 0; i < ARRAY_SIZE(expo_reg); i++)
+    {
+      if (expo_reg[i].data != expo_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+     }
+    return SUCCESS;
+
+}
+
+static int pCus_SetAEUSecsHDR_DOL_SEF(ms_cus_sensor *handle, u32 us)
+{
+    int i;
+    u32 half_lines = 0,dou_lines = 0,vts = 0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    I2C_ARRAY expo_reg_temp[] = {
+        {0x3e04, 0x21}, // expo[7:0]
+        {0x3e05, 0x00}, // expo[7:4]
+    };
+    memcpy(expo_reg_temp, expo_reg_HDR_DOL_SEF, sizeof(expo_reg_HDR_DOL_SEF));
+
+    dou_lines = (1000*us)/(Preview_line_period_HDR_DOL*2); // Preview_line_period in ns
+    half_lines = 4*dou_lines;
+    if(half_lines<8) half_lines=8;
+    if (half_lines >  2 * (params->expo.max_short_exp-8)) {
+        half_lines = 2 * (params->expo.max_short_exp-8);
+    }
+    else
+     vts=params->expo.vts;
+//  SENSOR_DMSG("[%s] us %ld, half_lines %ld, vts %ld\n", __FUNCTION__, us, half_lines, params->expo.vts);
+
+    half_lines = half_lines<<4;
+
+    expo_reg_HDR_DOL_SEF[0].data =  (half_lines>>8) & 0xff;
+    expo_reg_HDR_DOL_SEF[1].data = (half_lines>>0) & 0xf0;
+ //   pr_info("[%s]  expo_reg_HDR_DOL_SEF : %x , %x\n\n", __FUNCTION__,expo_reg_HDR_DOL_SEF[0].data,expo_reg_HDR_DOL_SEF[1].data);
+    for (i = 0; i < ARRAY_SIZE(expo_reg_HDR_DOL_SEF); i++)
+    {
+      if (expo_reg_HDR_DOL_SEF[i].data != expo_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+     }
+    return SUCCESS;
+
+}
+
+static int pCus_GetAEUSecs(ms_cus_sensor *handle, u32 *us) {
+
+  u32 lines = 0;
+  lines |= (u32)(expo_reg[0].data&0x0f)<<16;
+  lines |= (u32)(expo_reg[1].data&0xff)<<8;
+  lines |= (u32)(expo_reg[2].data&0xf0)<<0;
+  lines >>= 4;
+  *us = (lines*Preview_line_period)/1000/2; //return us
+
+  SENSOR_DMSG("[%s] sensor expo lines/us %d, %dus\n", __FUNCTION__, lines, *us);
+    return SUCCESS;
+}
+
+static int pCus_SetAEUSecs(ms_cus_sensor *handle, u32 us) {
+    int i;
+    u32 half_lines = 0,vts = 0;
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    I2C_ARRAY expo_reg_temp[] = {  // max expo line vts-4!
+    {0x3e00, 0x00},//expo [20:17]
+    {0x3e01, 0x00}, // expo[16:8]
+    {0x3e02, 0x10}, // expo[7:0], [3:0] fraction of line
+    };
+    memcpy(expo_reg_temp, expo_reg, sizeof(expo_reg));
+
+    half_lines = (1000*us*2)/Preview_line_period; // Preview_line_period in ns
+    if(half_lines<3) half_lines=3;
+    if (half_lines >  2 * (params->expo.vts)-10) {
+        vts = (half_lines+11)/2;
+    }
+    else
+        vts=params->expo.vts;
+
+    params->expo.line = half_lines;
+    SENSOR_DMSG("[%s] us %ld, half_lines %ld, vts %ld\n", __FUNCTION__, us, half_lines, params->expo.vts);
+
+    half_lines = half_lines<<4;
+
+    expo_reg[0].data = (half_lines>>16) & 0x0f;
+    expo_reg[1].data =  (half_lines>>8) & 0xff;
+    expo_reg[2].data = (half_lines>>0) & 0xf0;
+    vts_reg[0].data = (vts >> 8) & 0x00ff;
+    vts_reg[1].data = (vts >> 0) & 0x00ff;
+
+    for (i = 0; i < ARRAY_SIZE(expo_reg); i++)
+    {
+      if (expo_reg[i].data != expo_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+     }
+    return SUCCESS;
+}
+
+// Gain: 1x = 1024
+static int pCus_GetAEGain(ms_cus_sensor *handle, u32* gain) {
+    int rc = 0;
+    u8 Dgain = 1,  Coarse_gain = 1;
+
+    Coarse_gain = ((gain_reg[2].data&0x1C)>>2) +1;
+    Dgain = ((gain_reg[0].data&0x0f) + 1);
+
+    *gain = (Coarse_gain*Dgain*(gain_reg[1].data)*(gain_reg[3].data))/2;
+
+    return rc;
+}
+static int pCus_GetAEGainHDR_DOL_SEF(ms_cus_sensor *handle, u32* gain) {
+    int rc = 0;
+    u8 Dgain = 1,  Coarse_gain = 1;
+
+    Coarse_gain = ((gain_reg_HDR_DOL_SEF[2].data&0x1C)>>2) +1;
+    Dgain = ((gain_reg_HDR_DOL_SEF[0].data&0x0f) + 1);
+
+    *gain = (Coarse_gain*Dgain*(gain_reg_HDR_DOL_SEF[1].data)*(gain_reg_HDR_DOL_SEF[3].data))/2;
+
+
+    return rc;
+}
+
+static int pCus_SetAEGain_cal(ms_cus_sensor *handle, u32 gain) {
+
+    return SUCCESS;
+}
+
+static int pCus_SetAEGain(ms_cus_sensor *handle, u32 gain) {
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u8 i=0 ,Dgain = 1,  Ana_gain = 1;
+    u64 Fine_againx64 = 64,Fine_dgainx128 = 128;
+    u8 Dgain_reg = 0, Ana_gain_reg = 0, Fine_again_reg= 0x40,Fine_dgain_reg= 0x80;
+
+    I2C_ARRAY gain_reg_temp[] = {
+        {0x3e06, 0x00},
+        {0x3e07, 0x80},
+        {0x3e08, (0x00|0x03)},
+        {0x3e09, 0x40},
+    };
+    memcpy(gain_reg_temp, gain_reg, sizeof(gain_reg));
+
+    if (gain < 1024) {
+        gain = 1024;
+    } else if (gain > SENSOR_MAXGAIN*1024) {
+        gain = SENSOR_MAXGAIN*1024;
+    }
+
+    if (gain < 2 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 1;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x03;
+    }
+    else if (gain <  4 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 2;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x07;
+    }
+    else if (gain <  8 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 4;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x0f;
+    }
+    else if (gain <=  16256)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 8;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x1f;
+    }
+    else if (gain <  32512)
+    {
+        Dgain = 1;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x00;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+    else if (gain <  65024)
+    {
+        Dgain = 2;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x01;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+     else if (gain < 127 * 1024)
+    {
+        Dgain = 4;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x03;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+     else if (gain < 254 * 1024)
+    {
+        Dgain = 8;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x07;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+     else if (gain <= SENSOR_MAXGAIN * 1024)
+    {
+        Dgain = 16;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x0f;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+
+    if (gain <= 16256)
+    {
+        Fine_againx64 = abs(8 * gain/ (Dgain * Ana_gain * Fine_dgainx128));
+        //Fine_dgainx128 = abs(8 * gain/ (Dgain * Ana_gain * Fine_againx64));
+        Fine_again_reg = Fine_againx64;
+        //Fine_dgain_reg = Fine_dgainx128;
+    }
+    else
+    {
+        Fine_dgainx128 = abs(8 * gain/ (Dgain * Ana_gain * Fine_againx64));
+        Fine_dgain_reg = Fine_dgainx128;
+    }
+   //  pr_info("[%s]  gain : %d,%lld,%lld,%d, %d\n\n", __FUNCTION__,gain,Fine_again,Fine_dgainx128,Dgain,Ana_gain);
+    // pr_info("[%s]  gain_reg : %x ,%x ,%x , %x\n\n", __FUNCTION__,Fine_again_reg,Ana_gain_reg,Fine_dgain_reg,Dgain_reg);
+
+    gain_reg[3].data = Fine_again_reg;
+    gain_reg[2].data = Ana_gain_reg;
+    gain_reg[1].data = Fine_dgain_reg;
+    gain_reg[0].data = Dgain_reg & 0xF;
+    //pr_info("[%s]  gain_reg : %x ,%x ,%x , %x\n\n", __FUNCTION__,gain_reg[3].data,gain_reg[2].data,gain_reg[1].data,gain_reg[0].data);
+
+    for (i = 0; i < ARRAY_SIZE(gain_reg); i++)
+    {
+      if (gain_reg[i].data != gain_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+    }
+    return SUCCESS;
+}
+
+static int pCus_SetAEGainHDR_DOL_SEF(ms_cus_sensor *handle, u32 gain) {
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u8 i=0 ,Dgain = 1,  Ana_gain = 1;
+    u64 Fine_againx64 = 64,Fine_dgainx128 = 128;
+    u8 Dgain_reg = 0, Ana_gain_reg = 0, Fine_again_reg= 0x10,Fine_dgain_reg= 0x80;
+
+    I2C_ARRAY gain_reg_temp[] = {
+        {0x3e10, 0x00},
+        {0x3e11, 0x80},
+        {0x3e12, (0x00|0x03)},
+        {0x3e13, 0x40},
+    };
+    memcpy(gain_reg_temp, gain_reg_HDR_DOL_SEF, sizeof(gain_reg_HDR_DOL_SEF));
+
+    if (gain < 1024) {
+        gain = 1024;
+    } else if (gain > SENSOR_MAXGAIN*1024) {
+        gain = SENSOR_MAXGAIN*1024;
+    }
+
+    if (gain < 2 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 1;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x03;
+    }
+    else if (gain <  4 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 2;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x07;
+    }
+    else if (gain <  8 * 1024)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 4;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x0f;
+    }
+    else if (gain <=  16256)
+    {
+        Dgain = 1;      Fine_dgainx128 = 128;         Ana_gain = 8;
+        Dgain_reg = 0x00;  Fine_dgain_reg = 0x80;  Ana_gain_reg = 0x1f;
+    }
+    else if (gain <  32512)
+    {
+        Dgain = 1;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x00;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+    else if (gain <  65024)
+    {
+        Dgain = 2;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x01;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+     else if (gain < 127 * 1024)
+    {
+        Dgain = 4;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x03;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+     else if (gain < 254 * 1024)
+    {
+        Dgain = 8;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x07;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+     else if (gain <= SENSOR_MAXGAIN * 1024)
+    {
+        Dgain = 16;      Fine_againx64 = 127;    Ana_gain = 8;
+        Dgain_reg = 0x0f;  Fine_again_reg = 0x7f;  Ana_gain_reg = 0x1f;
+    }
+
+    if (gain <= 16256)
+    {
+        Fine_againx64 = abs(8 * gain/ (Dgain * Ana_gain * Fine_dgainx128));
+        //Fine_dgainx128 = abs(8 * gain/ (Dgain * Ana_gain * Fine_againx64));
+        Fine_again_reg = Fine_againx64;
+        //Fine_dgain_reg = Fine_dgainx128;
+    }
+    else
+    {
+        Fine_dgainx128 = abs(8 * gain/ (Dgain * Ana_gain * Fine_againx64));
+        Fine_dgain_reg = Fine_dgainx128;
+    }
+  // pr_info("[%s]  gain : %d,%lld,%lld,%d, %d\n\n", __FUNCTION__,gain,Fine_again,Fine_dgain,Dgain,Ana_gain);
+  // pr_info("[%s]  gain_reg : %x ,%x ,%x , %x\n\n", __FUNCTION__,Fine_again_reg,Ana_gain_reg,Fine_dgain_reg,Dgain_reg);
+
+    gain_reg_HDR_DOL_SEF[3].data = Fine_again_reg;
+    gain_reg_HDR_DOL_SEF[2].data = Ana_gain_reg;
+    gain_reg_HDR_DOL_SEF[1].data = Fine_dgain_reg;
+    gain_reg_HDR_DOL_SEF[0].data = Dgain_reg & 0xF;
+    //pr_info("[%s]  gain_reg : %x ,%x ,%x , %x\n\n", __FUNCTION__,gain_reg_HDR_DOL_SEF[3].data,gain_reg_HDR_DOL_SEF[2].data,gain_reg_HDR_DOL_SEF[1].data,gain_reg_HDR_DOL_SEF[0].data);
+
+    for (i = 0; i < ARRAY_SIZE(gain_reg_HDR_DOL_SEF); i++)
+    {
+      if (gain_reg_HDR_DOL_SEF[i].data != gain_reg_temp[i].data)
+      {
+        params->reg_dirty = true;
+        break;
+      }
+    }
+    return SUCCESS;
+}
+
+
+static int pCus_GetAEMinMaxUSecs(ms_cus_sensor *handle, u32 *min, u32 *max) {
+    *min = 30;
+    *max = 1000000/Preview_MIN_FPS;
+    return SUCCESS;
+}
+
+static int pCus_GetAEMinMaxGain(ms_cus_sensor *handle, u32 *min, u32 *max) {
+  *min = 1024;
+  *max = SENSOR_MAXGAIN*1024;
+  return SUCCESS;
+}
+
+static int sc8238_GetShutterInfo(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = Preview_line_period * 3;
+    info->step = Preview_line_period;
+    return SUCCESS;
+}
+static int pCus_GetShutterInfo_hdr_dol_lef(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    info->max = 1000000000/Preview_MIN_FPS;
+    info->min = (Preview_line_period_HDR_DOL * 4);
+    info->step = Preview_line_period_HDR_DOL*2;
+    return SUCCESS;
+}
+static int pCus_GetShutterInfo_hdr_dol_sef(struct __ms_cus_sensor* handle,CUS_SHUTTER_INFO *info)
+{
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    info->max = Preview_line_period_HDR_DOL * params->expo.max_short_exp;
+    info->min = (Preview_line_period_HDR_DOL * 4);
+    info->step = Preview_line_period_HDR_DOL*2;
+    return SUCCESS;
+}
+static int pCus_poweron_hdr_dol_lef(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+
+static int pCus_poweroff_hdr_dol_lef(ms_cus_sensor *handle, u32 idx)
+{
+    return SUCCESS;
+}
+static int pCus_GetSensorID_hdr_dol_lef(ms_cus_sensor *handle, u32 *id)
+{
+    *id = 0;
+     return SUCCESS;
+}
+static int pCus_init_hdr_dol_lef(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+#if 0
+static int pCus_GetVideoRes_hdr_dol_lef( ms_cus_sensor *handle, u32 res_idx, cus_camsensor_res **res )
+{
+    *res = &handle->video_res_supported.res[res_idx];
+    return SUCCESS;
+}
+
+static int pCus_SetVideoRes_hdr_dol_lef( ms_cus_sensor *handle, u32 res )
+{
+    handle->video_res_supported.ulcur_res = 0; //TBD
+    return SUCCESS;
+}
+#endif
+/* static int pCus_GetOrien_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT *orit)
+{
+    *orit = CUS_ORIT_M0F0;
+    return SUCCESS;
+}
+
+static int pCus_SetOrien_hdr_dol_lef(ms_cus_sensor *handle, CUS_CAMSENSOR_ORIT orit)
+{
+    return SUCCESS;
+} */
+
+static int pCus_GetFPS_hdr_dol_lef(ms_cus_sensor *handle)
+{
+    sc8238_params *params = (sc8238_params *)handle->private_data;
+    u32 max_fps = handle->video_res_supported.res[handle->video_res_supported.ulcur_res].max_fps;
+    u32 tVts = (vts_reg[0].data << 8) | (vts_reg[1].data << 0);
+
+    if (params->expo.fps >= 1000)
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps*1000)/tVts;
+    else
+        params->expo.preview_fps = (vts_30fps_HDR_DOL*max_fps)/tVts;
+
+    return params->expo.preview_fps;
+}
+
+static int pCus_setCaliData_gain_linearity_hdr_dol_lef(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num)
+{
+    return SUCCESS;
+}
+static int pCus_SetAEGain_cal_hdr_dol_lef(ms_cus_sensor *handle, u32 gain)
+{
+    return SUCCESS;
+}
+static int pCus_setCaliData_gain_linearity(ms_cus_sensor* handle, CUS_GAIN_GAP_ARRAY* pArray, u32 num) {
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_linear(ms_cus_sensor* drv_handle) {
+   ms_cus_sensor *handle = drv_handle;
+    sc8238_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (sc8238_params *)handle->private_data;
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"sc8238_MIPI");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_NONE;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 0; //Short frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= 15;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth= 3840;
+    handle->video_res_supported.res[0].nOutputHeight= 2160;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "3840x2160@15fps");
+
+    handle->video_res_supported.num_res = 2;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[1].width = Preview_WIDTH;
+    handle->video_res_supported.res[1].height = Preview_HEIGHT;
+    handle->video_res_supported.res[1].max_fps= 20;
+    handle->video_res_supported.res[1].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[1].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[1].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[1].nOutputWidth= 3840;
+    handle->video_res_supported.res[1].nOutputHeight= 2160;
+    sprintf(handle->video_res_supported.res[1].strResDesc, "3840x2160@20fps");
+
+	
+	handle->video_res_supported.num_res = 3;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[2].width = 3072;
+    handle->video_res_supported.res[2].height = 1728;
+    handle->video_res_supported.res[2].max_fps= 30;
+    handle->video_res_supported.res[2].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[2].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[2].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[2].nOutputWidth= 3072;
+    handle->video_res_supported.res[2].nOutputHeight= 1728;
+    sprintf(handle->video_res_supported.res[2].strResDesc, "3072x1728@30fps");
+	
+	
+    handle->video_res_supported.num_res = 4;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[3].width = 2592;
+    handle->video_res_supported.res[3].height = 1944;
+    handle->video_res_supported.res[3].max_fps= 30;
+    handle->video_res_supported.res[3].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[3].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[3].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[3].nOutputWidth= 2592;
+    handle->video_res_supported.res[3].nOutputHeight= 1944;
+    sprintf(handle->video_res_supported.res[3].strResDesc, "2592x1944@30fps");
+
+    handle->video_res_supported.num_res = 5;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[4].width = 2944;
+    handle->video_res_supported.res[4].height = 1656;
+    handle->video_res_supported.res[4].max_fps= 30;
+    handle->video_res_supported.res[4].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[4].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[4].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[4].nOutputWidth= 2944;
+    handle->video_res_supported.res[4].nOutputHeight= 1656;
+    sprintf(handle->video_res_supported.res[4].strResDesc, "2944x1656@30fps");
+
+    handle->video_res_supported.num_res = 6;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[5].width = 2560;
+    handle->video_res_supported.res[5].height = 1440;
+    handle->video_res_supported.res[5].max_fps= 30;
+    handle->video_res_supported.res[5].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[5].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[5].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[5].nOutputWidth= 2560;
+    handle->video_res_supported.res[5].nOutputHeight= 1440;
+    sprintf(handle->video_res_supported.res[5].strResDesc, "2560x1440@30fps");
+
+    handle->video_res_supported.num_res = 7;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[6].width = 1920;
+    handle->video_res_supported.res[6].height = 1080;
+    handle->video_res_supported.res[6].max_fps= 60;
+    handle->video_res_supported.res[6].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[6].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[6].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[6].nOutputWidth= 1920;
+    handle->video_res_supported.res[6].nOutputHeight= 1080;
+    sprintf(handle->video_res_supported.res[6].strResDesc, "1920x1080@60fps");
+
+    handle->video_res_supported.num_res = 8;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[7].width = Preview_WIDTH;
+    handle->video_res_supported.res[7].height = Preview_HEIGHT;
+    handle->video_res_supported.res[7].max_fps= 30;
+    handle->video_res_supported.res[7].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[7].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[7].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[7].nOutputWidth= 3840;
+    handle->video_res_supported.res[7].nOutputHeight= 2160;
+    sprintf(handle->video_res_supported.res[7].strResDesc, "3840x2160@30fps");
+
+    // i2c
+
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 2;
+    handle->ae_shutter_delay    = 2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 1;
+
+    ///calibration
+    handle->sat_mingain=g_sensor_ae_min_gain;
+
+
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init_mipi4lane_linear_4K15fps;
+
+    handle->pCus_sensor_poweron     = pCus_poweron ;
+    handle->pCus_sensor_poweroff    = pCus_poweroff;
+    handle->pCus_sensor_post_init   = pCus_post_init;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID   ;
+
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes;
+
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien      ;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien      ;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS      ;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS      ;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap;
+    handle->pCus_sensor_SetPatternMode = sc8238_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    //handle->pCus_sensor_GetAETrigger_mode      = pCus_GetAETrigger_mode;
+    //handle->pCus_sensor_SetAETrigger_mode      = pCus_SetAETrigger_mode;
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotify;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecs;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal;
+    handle->pCus_sensor_setCaliData_gain_linearity=pCus_setCaliData_gain_linearity;
+    handle->pCus_sensor_GetShutterInfo = sc8238_GetShutterInfo;
+   // params->expo.vts=vts_30fps;
+   // params->expo.fps = 30;
+    params->expo.line= 1000;
+    Preview_line_period  = 25720;
+    params->expo.fps = 15;
+    params->reg_dirty = false;
+    params->reg_mf = false;
+    return SUCCESS;
+}
+int cus_camsensor_init_handle_hdr_dol_sef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    sc8238_params *params = NULL;
+
+    cus_camsensor_init_handle_linear(drv_handle);
+    params = (sc8238_params *)handle->private_data;
+
+    sprintf(handle->model_id,"sc8238_MIPI_HDR_SEF");
+
+    handle->bayer_id    = SENSOR_BAYERID_HDR_DOL;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_DCG;
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth= 3840;
+    handle->video_res_supported.res[0].nOutputHeight= 2160;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "3840x2160@15fps");
+
+    handle->video_res_supported.num_res = 2;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[1].width = 1920;
+    handle->video_res_supported.res[1].height = 1080;
+    handle->video_res_supported.res[1].max_fps= 30;
+    handle->video_res_supported.res[1].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[1].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[1].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[1].nOutputWidth= 1920;
+    handle->video_res_supported.res[1].nOutputHeight= 1080;
+    sprintf(handle->video_res_supported.res[1].strResDesc, "1920x1080@30fps");
+
+
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes_HDR_DOL;
+    handle->mclk                        = Preview_MCLK_SPEED_HDR_DOL;
+
+    handle->pCus_sensor_init        = pCus_init_mipi4lane_HDR_DOL;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_HDR_DOL_SEF;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_HDR_DOL_SEF; //TBD
+
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotifyHDR_DOL_SEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_SEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGainHDR_DOL_SEF;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGainHDR_DOL_SEF;
+    handle->pCus_sensor_GetShutterInfo = pCus_GetShutterInfo_hdr_dol_sef;
+    params->expo.vts = vts_30fps_HDR_DOL;
+    params->expo.fps = 15;
+    params->expo.max_short_exp = 130;
+    handle->data_prec   = SENSOR_DATAPREC_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num = 1; //Short frame
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 2;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_init_handle_hdr_dol_lef(ms_cus_sensor* drv_handle)
+{
+    ms_cus_sensor *handle = drv_handle;
+    sc8238_params *params;
+    if (!handle) {
+        SENSOR_DMSG("[%s] not enough memory!\n", __FUNCTION__);
+        return FAIL;
+    }
+    SENSOR_DMSG("[%s]", __FUNCTION__);
+    //private data allocation & init
+    if (handle->private_data == NULL) {
+        SENSOR_EMSG("[%s] Private data is empty!\n", __FUNCTION__);
+        return FAIL;
+    }
+    params = (sc8238_params *)handle->private_data;
+
+    ////////////////////////////////////
+    //    sensor model ID                           //
+    ////////////////////////////////////
+    sprintf(handle->model_id,"sc8238_MIPI_HDR_LEF");
+
+    ////////////////////////////////////
+    //    sensor interface info       //
+    ////////////////////////////////////
+    //SENSOR_DMSG("[%s] entering function with id %d\n", __FUNCTION__, id);
+    handle->isp_type    = SENSOR_ISP_TYPE;  //ISP_SOC;
+    //handle->data_fmt    = SENSOR_DATAFMT;   //CUS_DATAFMT_YUV;
+    handle->sif_bus     = SENSOR_IFBUS_TYPE;//CUS_SENIF_BUS_PARL;
+    handle->data_prec   = SENSOR_DATAPREC_HDR_DOL;  //CUS_DATAPRECISION_8;
+    handle->data_mode   = SENSOR_DATAMODE;
+    handle->bayer_id    = SENSOR_BAYERID_HDR_DOL;   //CUS_BAYER_GB;
+    handle->RGBIR_id    = SENSOR_RGBIRID;
+    handle->orient      = SENSOR_ORIT;      //CUS_ORIT_M1F1;
+    //handle->YC_ODER     = SENSOR_YCORDER;   //CUS_SEN_YCODR_CY;
+    handle->interface_attr.attr_mipi.mipi_lane_num = SENSOR_MIPI_LANE_NUM;
+    handle->interface_attr.attr_mipi.mipi_data_format = CUS_SEN_INPUT_FORMAT_RGB; // RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_yuv_order = 0; //don't care in RGB pattern.
+    handle->interface_attr.attr_mipi.mipi_hsync_mode = SENSOR_MIPI_HSYNC_MODE_HDR_DOL;
+    handle->interface_attr.attr_mipi.mipi_hdr_mode = CUS_HDR_MODE_DCG;
+    handle->interface_attr.attr_mipi.mipi_hdr_virtual_channel_num =  0; //Long frame
+
+    ////////////////////////////////////
+    //    resolution capability       //
+    ////////////////////////////////////
+    handle->video_res_supported.num_res = 1;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[0].width = Preview_WIDTH;
+    handle->video_res_supported.res[0].height = Preview_HEIGHT;
+    handle->video_res_supported.res[0].max_fps= Preview_MAX_FPS;
+    handle->video_res_supported.res[0].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[0].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[0].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[0].nOutputWidth= 3840;
+    handle->video_res_supported.res[0].nOutputHeight= 2160;
+    sprintf(handle->video_res_supported.res[0].strResDesc, "3840x2160@15fps");
+
+    handle->video_res_supported.num_res = 2;
+    handle->video_res_supported.ulcur_res = 0; //default resolution index is 0.
+    handle->video_res_supported.res[1].width = 1920;
+    handle->video_res_supported.res[1].height = 1080;
+    handle->video_res_supported.res[1].max_fps= 30;
+    handle->video_res_supported.res[1].min_fps= Preview_MIN_FPS;
+    handle->video_res_supported.res[1].crop_start_x= Preview_CROP_START_X;
+    handle->video_res_supported.res[1].crop_start_y= Preview_CROP_START_Y;
+    handle->video_res_supported.res[1].nOutputWidth= 1920;
+    handle->video_res_supported.res[1].nOutputHeight= 1080;
+    sprintf(handle->video_res_supported.res[1].strResDesc, "1920x1080@30fps");
+
+
+    // i2c
+    handle->i2c_cfg.mode                = SENSOR_I2C_LEGACY;    //(CUS_ISP_I2C_MODE) FALSE;
+    handle->i2c_cfg.fmt                 = SENSOR_I2C_FMT;       //CUS_I2C_FMT_A16D16;
+    handle->i2c_cfg.address             = SENSOR_I2C_ADDR;      //0x5a;
+    handle->i2c_cfg.speed               = SENSOR_I2C_SPEED;     //320000;
+
+    // mclk
+    handle->mclk                        = Preview_MCLK_SPEED_HDR_DOL;
+
+    //polarity
+    /////////////////////////////////////////////////////
+    handle->pwdn_POLARITY               = SENSOR_PWDN_POL;  //CUS_CLK_POL_NEG;
+    handle->reset_POLARITY              = SENSOR_RST_POL;   //CUS_CLK_POL_NEG;
+    handle->VSYNC_POLARITY              = SENSOR_VSYNC_POL; //CUS_CLK_POL_POS;
+    handle->HSYNC_POLARITY              = SENSOR_HSYNC_POL; //CUS_CLK_POL_POS;
+    handle->PCLK_POLARITY               = SENSOR_PCLK_POL;  //CUS_CLK_POL_POS);    // use '!' to clear board latch error
+    /////////////////////////////////////////////////////
+
+
+
+    ////////////////////////////////////////////////////
+    // AE parameters
+    ////////////////////////////////////////////////////
+    handle->ae_gain_delay       = 2;//0;//1;
+    handle->ae_shutter_delay    = 2;//1;//2;
+
+    handle->ae_gain_ctrl_num = 1;
+    handle->ae_shutter_ctrl_num = 2;
+
+    ///calibration
+    handle->sat_mingain=g_sensor_ae_min_gain;
+
+    //LOGD("[%s:%d]\n", __FUNCTION__, __LINE__);
+    handle->pCus_sensor_release     = cus_camsensor_release_handle;
+    handle->pCus_sensor_init        = pCus_init_hdr_dol_lef;
+    //handle->pCus_sensor_powerupseq  = pCus_powerupseq   ;
+    handle->pCus_sensor_poweron     = pCus_poweron_hdr_dol_lef;
+    handle->pCus_sensor_poweroff    = pCus_poweroff_hdr_dol_lef;
+    handle->pCus_sensor_post_init   = pCus_post_init;
+
+    // Normal
+    handle->pCus_sensor_GetSensorID       = pCus_GetSensorID_hdr_dol_lef;
+    handle->pCus_sensor_GetVideoResNum = pCus_GetVideoResNum;
+    handle->pCus_sensor_GetVideoRes       = pCus_GetVideoRes;
+    handle->pCus_sensor_GetCurVideoRes  = pCus_GetCurVideoRes;
+    handle->pCus_sensor_SetVideoRes       = pCus_SetVideoRes_HDR_DOL;
+    handle->pCus_sensor_GetOrien          = pCus_GetOrien;
+    handle->pCus_sensor_SetOrien          = pCus_SetOrien_HDR;
+    handle->pCus_sensor_GetFPS          = pCus_GetFPS_hdr_dol_lef;
+    handle->pCus_sensor_SetFPS          = pCus_SetFPS_hdr_dol_lef;
+    //handle->pCus_sensor_GetSensorCap    = pCus_GetSensorCap_hdr_dol_lef;
+    handle->pCus_sensor_SetPatternMode = sc8238_SetPatternMode;
+    ///////////////////////////////////////////////////////
+    // AE
+    ///////////////////////////////////////////////////////
+    // unit: micro seconds
+    handle->pCus_sensor_AEStatusNotify = pCus_AEStatusNotifyHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEUSecs      = pCus_GetAEUSecs;
+    handle->pCus_sensor_SetAEUSecs      = pCus_SetAEUSecsHDR_DOL_LEF;
+    handle->pCus_sensor_GetAEGain       = pCus_GetAEGain;
+    //handle->pCus_sensor_SetAEGain       = pCus_SetAEGain_hdr_dol_lef;
+    handle->pCus_sensor_SetAEGain       = pCus_SetAEGain;
+
+    handle->pCus_sensor_GetAEMinMaxGain = pCus_GetAEMinMaxGain;
+    //handle->pCus_sensor_GetAEMinMaxUSecs= pCus_GetAEMinMaxUSecs_hdr_dol_lef;
+
+     //sensor calibration
+    handle->pCus_sensor_SetAEGain_cal   = pCus_SetAEGain_cal_hdr_dol_lef;
+    handle->pCus_sensor_setCaliData_gain_linearity= pCus_setCaliData_gain_linearity_hdr_dol_lef;
+    handle->pCus_sensor_GetShutterInfo = pCus_GetShutterInfo_hdr_dol_lef;
+
+    params->expo.vts = vts_30fps_HDR_DOL;
+    params->expo.fps = 15;
+    params->reg_dirty = false;
+
+    return SUCCESS;
+}
+
+int cus_camsensor_release_handle(ms_cus_sensor *handle)
+{
+    return SUCCESS;
+}
+
+SENSOR_DRV_ENTRY_IMPL_END_EX(  SC8235_HDR,
+                            cus_camsensor_init_handle_linear,
+                            cus_camsensor_init_handle_hdr_dol_sef,
+                            cus_camsensor_init_handle_hdr_dol_lef,
+                            sc8238_params
+                         );
+
+