[Feature]add MT2731_MP2_MR2_SVN388 baseline version

Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/navigation/sensor/2.0/test/main.cpp b/src/navigation/sensor/2.0/test/main.cpp
new file mode 100644
index 0000000..1126b7d
--- /dev/null
+++ b/src/navigation/sensor/2.0/test/main.cpp
@@ -0,0 +1,102 @@
+/*
+* 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 <stdint.h>
+#include <errno.h>
+#include <unistd.h>
+#include <string.h>
+#include <inttypes.h>
+
+#include <memory>
+#include <thread>
+#include <functional>
+
+#include <HfManager.h>
+
+int main(int argc, char **argv) {
+    int fd = -1;
+    int sensor = 0, action = 0, delay = 0, latency = 0;
+
+    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, "command: [%d,%d,%d,%d]\n", sensor, action, delay, latency);
+
+    std::unique_ptr<HfManager> mHfManager(new HfManager());
+    fd = mHfManager->getFd();
+    std::thread looperThread([fd]() {
+        std::unique_ptr<HfLooper> mHfLooper(new HfLooper(fd, 64));
+        while (1) {
+            int err = mHfLooper->eventLooper([](sensors_event_t const * event) {
+                fprintf(stderr, "data: [%d,%d,%" PRId64 ",%f,%f,%f]\n",
+                    event->sensor, event->reserved0, event->timestamp,
+                        event->data[0], event->data[1], event->data[2]);
+            });
+            switch (err) {
+            case -ENODEV:
+                fprintf(stderr, "looper stop nodevice error\n");
+                return;
+            }
+        };
+    });
+    looperThread.detach();
+    if (mHfManager->findSensor(sensor) < 0)
+        return -2;
+    switch (action) {
+    case HF_MANAGER_SENSOR_DISABLE:
+        mHfManager->disableSensor(sensor);
+        break;
+    case HF_MANAGER_SENSOR_ENABLE:
+        mHfManager->enableSensor(sensor, delay, latency);
+        break;
+    case HF_MANAGER_SENSOR_ENABLE_CALI:
+        mHfManager->requestFactoryCalibration(sensor, true);
+        mHfManager->enableFactoryCalibration(sensor);
+        break;
+    case HF_MANAGER_SENSOR_RAWDATA:
+        mHfManager->enableRawData(sensor);
+        break;
+    }
+    while (1)
+        sleep(1);
+    return 0;
+}