[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/navigation/sensor/sensorhaltest/log.c b/src/navigation/sensor/sensorhaltest/log.c
new file mode 100644
index 0000000..e24f745
--- /dev/null
+++ b/src/navigation/sensor/sensorhaltest/log.c
@@ -0,0 +1,95 @@
+/*
+* Copyright Statement:
+*
+* This software/firmware and related documentation ("MediaTek Software") are
+* protected under relevant copyright laws. The information contained herein is
+* confidential and proprietary to MediaTek Inc. and/or its licensors. Without
+* the prior written permission of MediaTek inc. and/or its licensors, any
+* reproduction, modification, use or disclosure of MediaTek Software, and
+* information contained herein, in whole or in part, shall be strictly
+* prohibited.
+*
+* MediaTek Inc. (C) 2017. All rights reserved.
+*
+* BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
+* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
+* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
+* ON AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL
+* WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
+* WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
+* NONINFRINGEMENT. NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH
+* RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
+* INCORPORATED IN, OR SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES
+* TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
+* RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
+* OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN MEDIATEK
+* SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE
+* RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
+* STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S
+* ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE
+* RELEASED HEREUNDER WILL BE, AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE
+* MEDIATEK SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
+* CHARGE PAID BY RECEIVER TO MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
+*/
+#include <sys/time.h>
+#include <stdarg.h>
+
+#include "log.h"
+
+typedef enum
+{
+ QUIET_L = 0,
+ ERROR_L,
+ WARNING_L,
+ INFO_L,
+ DEBUG_L,
+ LOGALL,
+ LogLevel_Cnt,
+} LogLevelDef;
+
+
+int log_dbg_level = (DEBUG_L);
+
+unsigned int get_time(void)
+{
+ struct timeval tv;
+
+ gettimeofday(&tv, NULL);
+
+ return tv.tv_sec * 1000 + tv.tv_usec / 1000;
+}
+
+extern int get_log_level()
+{
+ printf("Current debug level=%d", (int)log_dbg_level);
+
+ return log_dbg_level;
+}
+
+
+extern int set_log_level(int fg_enable, int level)
+{
+ printf(" Enter %s \n", __FUNCTION__);
+ printf("Current debug level=%d", (int)log_dbg_level);
+
+ if (level < QUIET_L || level > LOGALL)
+ {
+ printf("Invalid debug level, level=%d @ %s\n", level, __FUNCTION__);
+ printf(" [level] -\n");
+ printf(" QUIET = 0 \n");
+ printf(" ERROR = 1 \n");
+ printf(" WARNING = 2 \n");
+ printf(" INFO = 3 \n");
+ printf(" DEBUG = 4 \n");
+ printf(" LogAll = 5 \n");
+
+ return -1;
+ }
+
+ log_dbg_level = level;
+
+ printf(" Set log debug level successfully\n");
+ printf("New debug level=%d ", (int)log_dbg_level);
+
+ return 0;
+}
\ No newline at end of file