[Feature]add MT2731_MP2_MR2_SVN388 baseline version

Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/navigation/sensor/2.0/test/main.c b/src/navigation/sensor/2.0/test/main.c
new file mode 100644
index 0000000..275c2f0
--- /dev/null
+++ b/src/navigation/sensor/2.0/test/main.c
@@ -0,0 +1,94 @@
+/*
+* 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 <stdio.h>
+#include <stdint.h>
+#include <errno.h>
+#include <unistd.h>
+#include <string.h>
+#include <inttypes.h>
+#include <stdlib.h>
+#include <functional>
+
+#include <HfManagerWrapper.h>
+
+int main(int argc, char **argv) {
+    int sensor = 0, action = 0, delay = 0, latency = 0;
+    sensors_event_t data[32];
+
+    if (argc != 5) {
+        fprintf(stderr, "usage:         execute        sensor  action  delay  latency\n");
+        fprintf(stderr, "       ./high_freq_sensor_tool   1       1   5000000    0\n");
+        return -1;
+    }
+
+    sensor = atoi(argv[1]);
+    action = atoi(argv[2]);
+    delay = atoi(argv[3]);
+    latency = atoi(argv[4]);
+
+    fprintf(stderr, "cwrapper command: [%d,%d,%d,%d]\n", sensor, action, delay, latency);
+
+    void *mHfManager = HfManagerCreate();
+    void *mHfLooper = HfLooperCreate(HfManagerGetFd(mHfManager), 64);
+
+    if (HfManagerFindSensor(mHfManager, sensor) < 0)
+        return -2;
+    switch (action) {
+    case HF_MANAGER_SENSOR_DISABLE:
+        HfManagerDisableSensor(mHfManager, sensor);
+        break;
+    case HF_MANAGER_SENSOR_ENABLE:
+        HfManagerEnableSensor(mHfManager, sensor, delay, latency);
+        break;
+    case HF_MANAGER_SENSOR_RAWDATA:
+        HfManagerEnableRawData(mHfManager, sensor);
+        break;
+    }
+    while (1) {
+        int err = HfLooperEventLooper(mHfLooper, data, 32);
+        switch (err) {
+            case -ENODEV:
+            fprintf(stderr, "cwrapper looper stop nodevice error\n");
+            return -3;
+        }
+        for (int i = 0; i < err; ++i) {
+            fprintf(stderr, "cwrapper data: [%d,%d,%" PRId64 ",%f,%f,%f]\n",
+                    data[i].sensor, data[i].reserved0, data[i].timestamp,
+                        data[i].data[0], data[i].data[1], data[i].data[2]);
+        }
+    }
+    return 0;
+}