*voltage = adc_trans_systick_to_battery_ntc(stick);
else if (channel == 5)
*voltage = adc_trans_systick_to_pcb_ntc(stick);
- ///osal_printk("channel = %d , tick = %d , voltage = %.04f.\r\n", channel,stick,*voltage);
+ // osal_printk("channel = %d , tick = %d , voltage = %.04f.\r\n", channel,stick,*voltage);
UNUSED(discard_number);
return true;
uint8_t get_charge_stat(void)
{
uint16_t vbus_status = reg32_getbit(ULP_WKUP_INT_STS, 0x4);
- uint16_t g_ulp_wkup_flag = readw(ULP_WKUP_INT_STS);
+ uint16_t g_ulp_wkup_flag = reg32_getbit(ULP_WKUP_INT_STS, 0x5);
PRINT("get_charge_stat %02X %02X\r\n",vbus_status,g_ulp_wkup_flag);
if (vbus_status == 1) {
return 1;
#include "tcxo.h"
uint8_t batteryservice_get_voltage(float *voltage)
{
-
- // if (g_batter_service_initialled == false)
- // {
- // uapi_battery_init();
- // g_batter_service_initialled = true;
- // *voltage = 0;
- // return 0;
- // }
uint8_t percent = 0;
*voltage = current_battery_info.battery_voltage;
if (*voltage <= batteryservice_VOLTAGE_MIN)
uint8_t batteryservice_get_battery_temp(float *temp)
{
- // if (g_batter_service_initialled == false)
- // {
- // uapi_battery_init();
- // g_batter_service_initialled = true;
- // *temp = 0;
- // return 0;
- // }
-
*temp = current_battery_info.battery_ntc_temp;
return 0;
}
uint8_t batteryservice_get_pcb_temp(float *temp)
{
-
- // if (g_batter_service_initialled == false)
- // {
- // uapi_battery_init();
- // g_batter_service_initialled = true;
- // *temp = 0;
- // return 0;
- // }
*temp = current_battery_info.pcb_ntc_temp;
return 0;
}
* 电池电压读取逻辑:
* 充电10秒,停止充电1秒,并读取电压。之后再开始充电10秒,再停止充电一秒,读取电压,然后再开始充电。。。。依此类推。
* **/
-#define USE_APP_TIMER 1
#include "cmsis_os2.h"
#include "input_app.h"
-#if USE_APP_TIMER
+
osTimerId_t g_battery_timer = NULL;
-#else
-timer_handle_t g_battery_timer = {0};
-#endif
+
static bool g_bat_timer_is_running = false;
#define DISABLE_CHARGE_CHECK_MS 1000
#define ENABLE_CHARGE_TIMEOUT_MS 10000
-bool last_battery_charge_enable_status=false; // true上次刚设置在充电状态,false 上次设置不在充电状态。注意这个是充电IC的充电开关设置,并非真正处于充电状态的标识。
+bool last_battery_charge_enable_status=true; // true上次刚设置在充电状态,false 上次设置不在充电状态。注意这个是充电IC的充电开关设置,并非真正处于充电状态的标识。
static unsigned long g_app_queue;
#define BATTERY_CMD_CHECK_VOLTAGE 0x11
#define BATTERY_CMD_DISABLE_CHARGE 0x12
-#if USE_APP_TIMER
+
static void battery_check_timer_callback(void* data);
-#else
-static void battery_check_timer_callback(uint32_t data);
-#endif
+
static void battery_timer_start_check_released(uint32_t rtc_ms)
{
- // bool start = false;
- // if (!g_bat_timer_is_running) {
- // g_bat_timer_is_running = true;
- // start = true;
- // }
-
-
-#if USE_APP_TIMER
- if (g_bat_timer_is_running) osTimerStop(g_battery_timer);
- osTimerStart(g_battery_timer, rtc_ms);
-#else
- if (g_bat_timer_is_running) uapi_rtc_stop(g_battery_timer);
- uapi_rtc_start(g_battery_timer, rtc_ms, battery_check_timer_callback, 1);
-#endif
+ if (g_bat_timer_is_running) osTimerStop(g_battery_timer);
+ osTimerStart(g_battery_timer, rtc_ms);
g_bat_timer_is_running = true;
}
void do_battery_check_msg(int cmd);
static void battery_check_and_enable_charge(void);
-#if USE_APP_TIMER
+
+
static void battery_check_timer_callback(void * data)
-#else
-static void battery_check_timer_callback(uint32_t data)
-#endif
{
unused(data);
g_bat_timer_is_running = false;
if(last_battery_charge_enable_status == true){
- // do_battery_check_msg(BATTERY_CMD_DISABLE_CHARGE);
- disable_charge();
- uapi_tcxo_delay_ms(20);
+ do_battery_check_msg(BATTERY_CMD_DISABLE_CHARGE);
+ // disable_charge();
+ // uapi_tcxo_delay_ms(20);
battery_timer_start_check_released(DISABLE_CHARGE_CHECK_MS);
last_battery_charge_enable_status = false;
}else{
- // do_battery_check_msg(BATTERY_CMD_CHECK_VOLTAGE);
- battery_check_and_enable_charge();
- uapi_tcxo_delay_ms(20);
+ do_battery_check_msg(BATTERY_CMD_CHECK_VOLTAGE);
+ // battery_check_and_enable_charge();
+ // uapi_tcxo_delay_ms(20);
battery_timer_start_check_released(ENABLE_CHARGE_TIMEOUT_MS);
last_battery_charge_enable_status = true;
}
void uapi_battery_deinit(void)
{
/* Stop the time and clear the pin map */
-#if USE_APP_TIMER
osTimerStop(g_battery_timer);
osTimerDelete(g_battery_timer);
-#else
- uapi_rtc_stop(g_battery_timer);
- uapi_rtc_delete(g_battery_timer);
-#endif
g_bat_timer_is_running = false;
g_battery_timer = NULL;
}
common_notify_mail_t mail;
uint32_t msgsize = (uint32_t)sizeof(common_notify_mail_t);
-#if USE_APP_TIMER
- g_battery_timer = osTimerNew((osTimerFunc_t)battery_check_timer_callback, osTimerPeriodic, NULL, NULL);
-#else
- // ret = uapi_rtc_init();
-
- // ret |= uapi_rtc_adapter(0, RTC_0_IRQN, irq_prio(RTC_0_IRQN)); /* 1: using timer1 */
- // if (ret != ERRCODE_SUCC) {
- // PRINT("uapi_rtc_init FAILED 0x%x", ret);
- // return ;
- // }
- ret = uapi_rtc_create(RTC_1, &g_battery_timer); /* 1: using timer1 */
- if (ret != ERRCODE_SUCC) {
- PRINT("uapi_rtc_create FAILED 0x%x", ret);
- return ;
- }
-
-#endif
-
- //开始timer
- battery_timer_start_check_released(ENABLE_CHARGE_TIMEOUT_MS);
-
while (1) {
ret = osal_msg_queue_read_copy(g_app_queue, (void *)&mail, &msgsize,
OSAL_MSGQ_WAIT_FOREVER);
if (ret != OSAL_SUCCESS) {
continue;
}
-
+ get_charge_stat();
if (mail.comm.app == BATTERY_CMD_CHECK_VOLTAGE) {
battery_check_and_enable_charge();
uapi_tcxo_delay_ms(20);
return ERRCODE_FAIL;
}
- osal_kthread_set_priority(task_handle, APP_BOARD_TASK_PRIO);
+ // osal_kthread_set_priority(task_handle, APP_BOARD_TASK_PRIO);
+ osal_kthread_set_priority(task_handle, 10);
+ g_battery_timer = osTimerNew((osTimerFunc_t)battery_check_timer_callback, osTimerPeriodic, NULL, NULL);
+ //开始timer
+ battery_timer_start_check_released(DISABLE_CHARGE_CHECK_MS);
return ERRCODE_SUCC;
}
* 2022-08-16, Create file. \n
*/
-#ifndef BATTERY_H__
-#define BATTERY_H__
+#ifndef BATTERY_SERVICE_H__
+#define BATTERY_SERVICE_H__
#ifdef __cplusplus
#if __cplusplus
#ifdef SUPPORT_BATTERY_SERVICE
#include "battery_service.h"
#endif
-
+#ifdef MAG_MMC5603
+#include "mag_service.h"
+#endif
+#ifdef ACC_LIS2DOC
+#include "acc_service.h"
+#endif
#define EMMC_BASE_ADDR 0x52062000
#define TASK_PRIORITY_APP (osPriority_t)(17)
#define TICK_TEN_MS (10U)
#ifdef SUPPORT_BATTERY_SERVICE
uapi_battery_init();
+#endif
+#ifdef MAG_MMC5603
+ uapi_mag_service_init();
+#endif
+#ifdef ACC_LIS2DOC
+ uapi_acc_service_init();
#endif
set_startup_finish_flag();
}
#ifdef __cplusplus\r
extern "C" {\r
#endif\r
+#include "mag_service.h"\r
+\r
\r
using namespace OHOS;\r
\r
\r
void CompassModel::SetDisplayAngle(uint16_t angle)\r
{\r
- displayAngle += angle;\r
- if (displayAngle > 359) {\r
- displayAngle = 0;\r
- }\r
+ displayAngle = (int16_t)mag_service_get_fAzimuth();\r
}\r
\r
uint16_t CompassModel::GetDisplayAngle(void)\r
\r
bool CompassModel::OpenCompassSensor(void)\r
{\r
+\r
+ do_mag_service_check_msg(MAG_SERVICE_CMD_START_CHECK);\r
return true;\r
}\r
\r
bool CompassModel::CloseCompassSensor(void)\r
{\r
+ do_mag_service_check_msg(MAG_SERVICE_CMD_STOP_CHECK);\r
return true;\r
}\r
}\r
heapMan->stat.taskMemstats[taskId].memUsed, heapMan->stat.taskMemstats[taskId].memPeak);
}
wstp_print("\r\n");
-
+ wstp_print("mem total used 0x%-8x peak 0x%-8x\r\n",
+ heapMan->stat.memTotalUsed, heapMan->stat.memTotalPeak);
#endif
#if defined __FREERTOS__ && defined FREERTOS_DEBUG
freertos_heap_print();
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L9 dsp uart TP35
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L10 dsp uart TP36
#endif
- { HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L11 a+g int1
+ { HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L11 G_INT1
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L12 i2c data HX3507_SDIO
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_DISABLE }, // S_AGPIO_L13 i2c CLK HX3507_SCLK
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L17 HX3507_INT
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_DISABLE }, // S_AGPIO_L18 VDDEN //暂时无用,采用VDDIO 默认开启 EXt V3.0 EXt V1.8
- { HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L19 a+g int1
+ { HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_ENBALE }, // S_AGPIO_L19 G_INT2
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_DISABLE }, // S_AGPIO_L20 0.2C_CHRG
{ HAL_PIO_FUNC_GPIO, HAL_PIO_DRIVE_MAX, HAL_PIO_PULL_MAX, HAL_PIO_IE_DISABLE }, // S_AGPIO_L21 NTC_VDD_ON 给低打开 NTC上拉电源
//默认开启 EXT LDO V3.0 V1.8
{ S_AGPIO_L18, HAL_GPIO_DIRECTION_OUTPUT, HAL_GPIO_LEVEL_HIGH, 0, NULL },
+
+ /**G sensor G_INT1 S_AGPIO_L11 G_INT2 S_AGPIO_L19*/
+ { S_AGPIO_L11, HAL_GPIO_DIRECTION_INPUT, HAL_GPIO_LEVEL_HIGH, 0, NULL },
+ { S_AGPIO_L19, HAL_GPIO_DIRECTION_INPUT, HAL_GPIO_LEVEL_HIGH, 0, NULL },
+
};
/**
* @}
}
#if defined(CONFIG_I2C_SUPPORT_MASTER) && (CONFIG_I2C_SUPPORT_MASTER == 1)
-static errcode_t i2c_master_init_check(i2c_bus_t bus, uint32_t baudrate, uint8_t hscode)
+errcode_t i2c_master_init_check(i2c_bus_t bus, uint32_t baudrate, uint8_t hscode)
{
if (unlikely(bus >= I2C_BUS_MAX_NUM)) {
return ERRCODE_I2C_INVALID_PARAMETER;
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/lis2doc_porting.c
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/lis2doc_at_cmd.c
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/driver/lis2doc_reg.c
- ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_activity.c
+ # ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_activity.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_free_fall.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_orientation.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_read_data_polling.c
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_read_data_single.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_read_fifo.c
- ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_self_test.c
- ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_wake_up.c
+ # ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_self_test.c
+ # ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_wake_up.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/service/acc_service.c
)
set(PUBLIC_HEADER
+ ${CMAKE_CURRENT_SOURCE_DIR}/service
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC
)
set(PUBLIC_DEFINES
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/lis2doc_porting.c
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/lis2doc_at_cmd.c
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/driver/lis2doc_reg.c
- ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_activity.c
+ # ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_activity.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_free_fall.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_orientation.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_read_data_polling.c
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_read_data_single.c
# ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_read_fifo.c
- ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_self_test.c
- ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_wake_up.c
+ # ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_self_test.c
+ # ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/examples/lis2doc_wake_up.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/service/acc_service.c
)
set(PUBLIC_HEADER
+ ${CMAKE_CURRENT_SOURCE_DIR}/service
${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC
)
set(PUBLIC_DEFINES
--- /dev/null
+/*
+ ******************************************************************************
+ * @file activity.c
+ * @author Sensors Software Solution Team
+ * @brief This file show the simplest way to detect activity/inactivity
+ * from sensor.
+ *
+ ******************************************************************************
+ * @attention
+ *
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.
+ * All rights reserved.</center></h2>
+ *
+ * This software component is licensed by ST under BSD 3-Clause license,
+ * the "License"; You may not use this file except in compliance with the
+ * License. You may obtain a copy of the License at:
+ * opensource.org/licenses/BSD-3-Clause
+ *
+ ******************************************************************************
+ */
+
+/*
+ * This example was developed using the following STMicroelectronics
+ * evaluation boards:
+ *
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3
+ *
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package
+ *
+ * Used interfaces:
+ *
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)
+ * - Sensor side: SPI(Default) / I2C(supported)
+ *
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge
+ * - I2C(Default) / SPI(supported)
+ *
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge
+ * - Sensor side: I2C(Default) / SPI(supported)
+ *
+ * If you need to run this example on a different hardware platform a
+ * modification of the functions: `platform_write`, `platform_read`,
+ * `tx_com` and 'platform_init' is required.
+ *
+ */
+
+/* STMicroelectronics evaluation boards definition
+ *
+ * Please uncomment ONLY the evaluation boards in use.
+ * If a different hardware is used please comment all
+ * following target board and redefine yours.
+ */
+
+//#define STEVAL_MKI109V3 /* little endian */
+//#define NUCLEO_F411RE /* little endian */
+//#define SPC584B_DIS /* big endian */
+
+/* ATTENTION: By default the driver is little endian. If you need switch
+ * to big endian please see "Endianness definitions" in the
+ * header file of the driver (_reg.h).
+ */
+
+
+#if defined(STEVAL_MKI109V3)
+/* MKI109V3: Define communication interface */
+#define SENSOR_BUS hspi2
+/* MKI109V3: Vdd and Vddio power supply values */
+#define PWM_3V3 915
+
+#elif defined(NUCLEO_F411RE)
+/* NUCLEO_F411RE: Define communication interface */
+#define SENSOR_BUS hi2c1
+
+#elif defined(SPC584B_DIS)
+/* DISCOVERY_SPC584B: Define communication interface */
+#define SENSOR_BUS I2CD1
+
+#endif
+
+/* Includes ------------------------------------------------------------------*/
+#include <string.h>
+#include <stdio.h>
+#include "lis2doc_reg.h"
+#include "lis2doc_porting.h"
+
+/* Private macro -------------------------------------------------------------*/
+#define BOOT_TIME 20 //ms
+
+/* Private variables ---------------------------------------------------------*/
+static lis2doc_mode_t pm;
+static uint8_t whoamI, rst;
+static uint8_t tx_buffer[1000];
+
+
+/* Main Example --------------------------------------------------------------*/
+void lis2doc_init(void)
+{
+ /* Initialize mems driver interface */
+ stmdev_ctx_t dev_ctx;
+ lis2doc_reg_t int_route;
+ dev_ctx.write_reg = platform_write;
+ dev_ctx.read_reg = platform_read;
+ dev_ctx.handle = &SENSOR_BUS;
+ /* Initialize platform specific hardware */
+ platform_init();
+ /* Wait sensor boot time */
+ platform_delay(BOOT_TIME);
+ /* Check device ID */
+ lis2doc_device_id_get(&dev_ctx, &whoamI);
+
+ if (whoamI != LIS2DOC_ID)
+ {
+ /* manage here device not found */
+ LIS_ERROR("read lis2doc id 0x%02X != 0x%02X\r\n",whoamI,LIS2DOC_ID);
+ return ;
+ }
+
+ /* Restore default configuration */
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);
+
+ do {
+ lis2doc_reset_get(&dev_ctx, &rst);
+ } while (rst);
+
+ /* Set full scale */
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);
+ /* Configure filtering chain
+ * Accelerometer - filter path / bandwidth
+ */
+ lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);
+ lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_4);
+
+ /* Configure power mode */
+ pm.lpm = 1;
+ pm.low_noise = 1;
+ lis2doc_power_mode_set(&dev_ctx, pm);
+
+ /* Set wake-up duration
+ * Wake up duration event 1LSb = 1 / ODR
+ */
+ lis2doc_wkup_dur_set(&dev_ctx, 2);
+ /* Set sleep duration
+ * Duration to go in sleep mode (1 LSb = 512 / ODR)
+ */
+ lis2doc_act_sleep_dur_set(&dev_ctx, 2);
+ /* Set Activity wake-up threshold
+ * Threshold for wake-up 1 LSB = FS_XL / 64
+ */
+ lis2doc_wkup_threshold_set(&dev_ctx, 2);
+ /* Data sent to wake-up interrupt function */
+ lis2doc_wkup_feed_data_set(&dev_ctx, LIS2DOC_HP_FEED);
+ /* Config activity / inactivity or stationary / motion detection */
+ lis2doc_act_mode_set(&dev_ctx, LIS2DOC_DETECT_ACT_INACT);
+ /* Enable activity detection interrupt */
+ lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);
+ int_route.ctrl4_int1_pad_ctrl.int1_wu = PROPERTY_ENABLE;
+ lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);
+ /* Set Output Data Rate */
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);
+
+}
#include "lis2doc_reg.h"\r
#include "lis2doc_porting.h"\r
\r
-\r
+#include "pinctrl.h"\r
+#include "platform_core.h"\r
+#include "gpio.h"\r
+#include "gpio_porting.h"\r
+#include "errcode.h"\r
/* Private macro -------------------------------------------------------------*/\r
#define BOOT_TIME 20 //ms\r
\r
/* Private variables ---------------------------------------------------------*/\r
static lis2doc_mode_t pm;\r
static int16_t data_raw_acceleration[3];\r
-static float acceleration_mg[3];\r
+// static float acceleration_mg[3];\r
static uint8_t whoamI, rst;\r
static uint8_t tx_buffer[1000];\r
static lis2doc_ctrl4_int1_pad_ctrl_t ctrl4_int1_pad;\r
+static stmdev_ctx_t dev_ctx;\r
+#define G_INT1_PIN S_AGPIO_L11\r
+#define G_INT2_PIN S_AGPIO_L19\r
\r
+static int lis2doc_install_success = -1;\r
\r
-/* Main Example --------------------------------------------------------------*/\r
-void lis2doc_read_data_single(void)\r
+/*初始化GPIO*/\r
+int gpio_int_pin_init(void)\r
+{\r
+ if ((uapi_pin_set_mode(G_INT1_PIN, (pin_mode_t)HAL_PIO_FUNC_GPIO) != ERRCODE_SUCC) ||\r
+ (uapi_pin_set_pull(G_INT1_PIN, (pin_pull_t)HAL_PIO_PULL_UP) != ERRCODE_SUCC) ||\r
+ (uapi_gpio_set_dir(G_INT1_PIN, GPIO_DIRECTION_INPUT) != ERRCODE_SUCC)) {\r
+ PRINT("gpio G_INT1_PIN config failed\r\n");\r
+ return ERRCODE_FAIL;\r
+ }\r
+ if ((uapi_pin_set_mode(G_INT2_PIN, (pin_mode_t)HAL_PIO_FUNC_GPIO) != ERRCODE_SUCC) ||\r
+ (uapi_pin_set_pull(G_INT2_PIN, (pin_pull_t)HAL_PIO_PULL_UP) != ERRCODE_SUCC) ||\r
+ (uapi_gpio_set_dir(G_INT2_PIN, GPIO_DIRECTION_INPUT) != ERRCODE_SUCC)) {\r
+ PRINT("gpio G_INT2_PIN config failed\r\n");\r
+ return ERRCODE_FAIL;\r
+ }\r
+ return ERRCODE_SUCC;\r
+}\r
+\r
+\r
+int lis2doc_read_data_single_init(void)\r
{\r
- /* Initialize mems driver interface */\r
- stmdev_ctx_t dev_ctx;\r
+ /* Initialize mems driver interface */\r
+ if(lis2doc_install_success == 1) return ERRCODE_SUCC;\r
+ \r
dev_ctx.write_reg = platform_write;\r
dev_ctx.read_reg = platform_read;\r
dev_ctx.handle = &SENSOR_BUS;\r
/* Initialize platform specific hardware */\r
platform_init();\r
+\r
+ gpio_int_pin_init();\r
+\r
/* Wait sensor boot time */\r
platform_delay(BOOT_TIME);\r
/* Check device ID */\r
{\r
/* manage here device not found */\r
LIS_ERROR("read lis2doc id 0x%02X != 0x%02X\r\n",whoamI,LIS2DOC_ID);\r
- return ;\r
+ lis2doc_install_success = 0;\r
+ return ERRCODE_FAIL;\r
}\r
\r
+ lis2doc_install_success = 1;\r
\r
/* Restore default configuration */\r
lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
-\r
+ // uint8_t count=0;\r
do {\r
lis2doc_reset_get(&dev_ctx, &rst);\r
} while (rst);\r
lis2doc_power_mode_set(&dev_ctx, pm);\r
\r
lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_SET_SW_TRIG);\r
+ return ERRCODE_SUCC;\r
+}\r
+int lis2doc_read_data_single(float *x,float *y ,float *z)\r
+{\r
+\r
+\r
+ if(lis2doc_install_success == -1) \r
+ { \r
+ lis2doc_read_data_single_init();\r
+ }\r
+ if(lis2doc_install_success == 0) \r
+ {\r
+ return ERRCODE_FAIL;\r
+ }\r
+ /* Read samples in polling mode (no int) */\r
\r
- /* Read samples in polling mode (no int) */\r
- while (1) {\r
/* polling on DRDY signal */\r
// if (GPIO_PIN_RESET == HAL_GPIO_ReadPin(GPIOC, GPIO_PIN_0)) {\r
- if (1 == 0) {\r
+ uint8_t val = uapi_gpio_get_val(G_INT1_PIN);\r
+ uint8_t val2 = uapi_gpio_get_val(G_INT2_PIN);\r
+ // PRINT("G_INT1_PIN %u,G_INT2_PIN %u \r\n",val,val2);\r
+ if( val == 0 || val2 == 0)\r
+ {\r
/* Read acceleration data */\r
memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));\r
lis2doc_acceleration_raw_get(&dev_ctx, data_raw_acceleration);\r
- acceleration_mg[0] = lis2doc_from_fs2_lp1_to_mg(\r
+ *x = lis2doc_from_fs2_lp1_to_mg(\r
data_raw_acceleration[0]);\r
- acceleration_mg[1] = lis2doc_from_fs2_lp1_to_mg(\r
+ *y = lis2doc_from_fs2_lp1_to_mg(\r
data_raw_acceleration[1]);\r
- acceleration_mg[2] = lis2doc_from_fs2_lp1_to_mg(\r
+ *z = lis2doc_from_fs2_lp1_to_mg(\r
data_raw_acceleration[2]);\r
-\r
+ *x = (*x)/1000.0f;\r
+ *y = (*y)/1000.0f;\r
+ *z = (*z)/1000.0f;\r
lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_SET_SW_TRIG);\r
+\r
+ }\r
+ return ERRCODE_SUCC;\r
+\r
+}\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_read_data(void)\r
+{\r
+ float x,y,z;\r
+ if(lis2doc_read_data_single(&x,&y,&z)==ERRCODE_SUCC)\r
+ {\r
+\r
sprintf((char *)tx_buffer,\r
"Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",\r
- acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);\r
+ x, y, z);\r
tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
}\r
- }\r
+ \r
}\r
\r
#include "at_cmd_api.h"
#include "pm_control.h"
#include "lis2doc_porting.h"
+#include "acc_service.h"
#define ARRAY_COUNT(array) (sizeof(array) / sizeof(array[0]))
#define LIS2DOC_MAX_ARGC 8
return ERRCODE_FAIL;
}
char *mode = (char*)argv[0];
- if (strcmp(mode, "activity") == 0) {
- lis2doc_activity();
- } else if (strcmp(mode, "wakeup") == 0) {
- lis2doc_wake_up();
- } else if (strcmp(mode, "selftest") == 0) {
- lis2doc_self_test();
- } else if (strcmp(mode, "readsingle") == 0) {
- lis2doc_read_data_single();
+ if (strcmp(mode, "start") == 0) {
+ do_acc_service_check_msg(ACC_SERVICE_CMD_START_CHECK);
+ } else if (strcmp(mode, "stop") == 0) {
+ do_acc_service_check_msg(ACC_SERVICE_CMD_STOP_CHECK);
}
return ERRCODE_SUCC;
}
/* init i2c */
if ( g_acc_installed == 1 )
return ;
+ result = uapi_i2c_master_init(LIS2DOC_I2C_BUS, 400000, I2C_SPEED_MODE_FS);
+ if ( result == ERRCODE_I2C_ALREADY_INIT)
+ {
+ g_acc_installed = 1;
+ LIS_WARNING("lis2doc:i2c_id = %d i2c_speed = %d slave_addr = 0x%x ,already initiallized\r\n",
+ LIS2DOC_I2C_BUS, 400000, LIS2DOC_I2C_DEV_7ADDR);
+ return ;
+ }
result = uapi_i2c_master_init(LIS2DOC_I2C_BUS, 400000, I2C_SPEED_MODE_FS); /* 400000: 400KHz */
if (result != ERRCODE_SUCC) {
/******test functions********/
-void lis2doc_activity(void);
-void lis2doc_wake_up(void);
-void lis2doc_self_test(void);
-void lis2doc_read_data_single(void);
+// void lis2doc_activity(void);
+// void lis2doc_wake_up(void);
+// void lis2doc_self_test(void);
+// void lis2doc_read_data_single(void);
#endif
\ No newline at end of file
--- /dev/null
+/**
+ * Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved. \n
+ *
+ * Description: Test adc source \n
+ * Author: @CompanyNameTag \n
+ * History: \n
+ * 2022-08-16, Create file. \n
+ */
+
+#include "pinctrl.h"
+#include "debug_print.h"
+#include "soc_osal.h"
+#include "tcxo.h"
+#include "irmalloc.h"
+#include "errcode.h"
+#include "common_def.h"
+
+#include "chip_core_irq.h"
+#include "chip_io.h"
+#include "gpio.h"
+#include "pm_veto.h"
+
+#include "rtc.h"
+#include "timer.h"
+#include "systick.h"
+
+#include "lis2doc_porting.h"
+
+static bool g_batter_service_initialled = false;
+
+#include "tcxo.h"
+
+#include "cmsis_os2.h"
+#include "input_app.h"
+#include "mmc5603_hal.h"
+#include "acc_service.h"
+
+
+/***
+ * 其他cmd在Header里定义,对外开放
+*/
+#define ACC_SERVICE_CMD_TIMER_CHECK 0x11
+
+osTimerId_t g_acc_service_timer = NULL;
+
+static bool g_bat_timer_is_running = false;
+#define ACC_CHECK_MS 100
+static unsigned long g_app_queue;
+
+static bool acc_service_running_stat = false;
+static void acc_service_check_timer_callback(void* data);
+
+static void acc_service_timer_start_check(uint32_t rtc_ms)
+{
+
+ if (g_bat_timer_is_running ) osTimerStop(g_acc_service_timer);
+ if (acc_service_running_stat == true) osTimerStart(g_acc_service_timer, rtc_ms);
+ g_bat_timer_is_running = true;
+
+}
+void do_acc_service_check_msg(int cmd);
+
+static void acc_service_check_timer_callback(void * data)
+{
+ unused(data);
+
+ g_bat_timer_is_running = false;
+
+ if(acc_service_running_stat == true){
+ // mmc5603_check();
+ lis2doc_read_data();
+ acc_service_timer_start_check(ACC_CHECK_MS);
+ }
+ // do_acc_service_check_msg(ACC_SERVICE_CMD_TIMER_CHECK);
+ // uapi_tcxo_delay_ms(20);
+
+
+
+}
+void uapi_acc_service_deinit(void)
+{
+ /* Stop the time and clear the pin map */
+ osTimerStop(g_acc_service_timer);
+ osTimerDelete(g_acc_service_timer);
+
+ g_bat_timer_is_running = false;
+ g_acc_service_timer = NULL;
+}
+
+
+
+void do_acc_service_check_msg(int cmd)
+{
+ int ret;
+
+ common_notify_mail_t mail = {0};
+ mail.comm.app = cmd;
+ ret = osal_msg_queue_write_copy(g_app_queue, (void *)&mail,
+ sizeof(common_notify_mail_t), 0);
+ if (ret != OSAL_SUCCESS) {
+ PRINT("Error mag Check MSG 0x%02X send failed! err=0x%x! \r\n",cmd, ret);
+ }
+
+}
+
+static void acc_service_check_task(void const *arg)
+{
+ unused(arg);
+ int32_t ret;
+ common_notify_mail_t mail;
+ uint32_t msgsize = (uint32_t)sizeof(common_notify_mail_t);
+
+ while (1) {
+ ret = osal_msg_queue_read_copy(g_app_queue, (void *)&mail, &msgsize,
+ OSAL_MSGQ_WAIT_FOREVER);
+ if (ret != OSAL_SUCCESS) {
+ continue;
+ }
+
+ if (mail.comm.app == ACC_SERVICE_CMD_TIMER_CHECK) {
+ // acc_service_check_and_enable_charge();
+ // mmc5603_check();
+ PRINT("ACC_SERVICE_CMD_TIMER_CHECK\r\n");
+ }else if (mail.comm.app == ACC_SERVICE_CMD_START_CHECK){
+ acc_service_running_stat = true;
+ // lis2doc_read_data_single_init();
+ acc_service_timer_start_check(ACC_CHECK_MS);
+ }else if (mail.comm.app == ACC_SERVICE_CMD_STOP_CHECK){
+ acc_service_running_stat = false;
+ osTimerStop(g_acc_service_timer);
+
+ }
+ }
+}
+
+errcode_t uapi_acc_service_init(void)
+{
+ if (osal_msg_queue_create("acc_service_queue", APP_BOARD_MSG_COUNT, &g_app_queue,
+ 0, sizeof(common_notify_mail_t)) != ERRCODE_SUCC) {
+ PRINT("[mag][service] app create mail fail\n");
+ return ERRCODE_FAIL;
+ }
+
+
+ osal_task *task_handle = osal_kthread_create((osal_kthread_handler)acc_service_check_task, NULL,
+ "acc_service_service", APP_BOARD_TASK_SIZE);
+ if (task_handle == NULL) {
+ osal_msg_queue_is_full(g_app_queue);
+ PRINT("create mag service thread fail!\r\n");
+ return ERRCODE_FAIL;
+ }
+
+ // osal_kthread_set_priority(task_handle, APP_BOARD_TASK_PRIO);
+ osal_kthread_set_priority(task_handle, 10);
+
+ g_acc_service_timer = osTimerNew((osTimerFunc_t)acc_service_check_timer_callback, osTimerPeriodic, NULL, NULL);
+
+
+ return ERRCODE_SUCC;
+}
+
+// void acc_service_service_resume(void)
+// {
+// PRINT("acc_service_service resume!\r\n");
+// acc_service_check_timer_callback(0);
+// }
+// void acc_service_service_suspend(void)
+// {
+// PRINT("acc_service_service suspend!\r\n");
+// }
\ No newline at end of file
--- /dev/null
+/**
+ * Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved. \n
+ *
+ * Description: Test adc header \n
+ * Author: @CompanyNameTag \n
+ * History: \n
+ * 2022-08-16, Create file. \n
+ */
+
+#ifndef ACC_SERVICE_H__
+#define ACC_SERVICE_H__
+
+#ifdef __cplusplus
+#if __cplusplus
+extern "C" {
+#endif /* __cplusplus */
+#endif /* __cplusplus */
+
+#include "stdint.h"
+#include "errcode.h"
+
+
+#define ACC_SERVICE_CMD_START_CHECK 0x12
+#define ACC_SERVICE_CMD_STOP_CHECK 0x13
+
+errcode_t uapi_acc_service_init(void);
+void uapi_acc_service_deinit(void);
+/**
+ * 测试指令 参数cmd 选项: ACC_SERVICE_CMD_START_CHECK,ACC_SERVICE_CMD_STOP_CHECK
+*/
+void do_acc_service_check_msg(int cmd);
+
+int lis2doc_read_data_single(float *x,float *y,float *z);
+
+void lis2doc_read_data(void);
+
+#ifdef __cplusplus
+#if __cplusplus
+}
+#endif /* __cplusplus */
+#endif /* __cplusplus */
+
+#endif
\ No newline at end of file
if("MAG_MMC5603" IN_LIST DEFINES)
set(SOURCES ${SOURCES}
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/Customer.c
- ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/mmc5603_main.c
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/mmc5603_at_cmd.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/service/mag_service.c
)
set(PUBLIC_HEADER
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603
+ ${CMAKE_CURRENT_SOURCE_DIR}/service
)
set(PUBLIC_DEFINES
+ MAG_MMC5603
SUPPORT_AT_MMC5603
)
else()
set(SOURCES ${SOURCES}
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/Customer.c
- ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/mmc5603_main.c
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/mmc5603_at_cmd.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/service/mag_service.c
)
set(PUBLIC_HEADER
${CMAKE_CURRENT_SOURCE_DIR}/mmc5603
+ ${CMAKE_CURRENT_SOURCE_DIR}/service
)
set(PUBLIC_DEFINES
+ MAG_MMC5603
SUPPORT_AT_MMC5603
)
endif()
set(PRIVATE_DEFINES
)
-
-
# use this when you want to add ccflags like -include xxx
set(COMPONENT_PUBLIC_CCFLAGS
)
build_component()
install_sdk(${CMAKE_CURRENT_SOURCE_DIR} "*")
+
+find_library(LIB_PATH_MMC5603 ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MemsicAlgo.a ${CMAKE_CURRENT_SOURCE_DIR})
+target_link_libraries(${TARGET_NAME} PRIVATE -Wl,--whole-archive ${LIB_PATH_MMC5603} PRIVATE -Wl,--whole-archive)
\ No newline at end of file
/**\r
* @brief Delay function.\r
*/\r
-void mmc5603_mmc5603_Delay_Ms(int cnt);\r
+void mmc5603_Delay_Ms(int cnt);\r
\r
/**\r
* @brief Delay function.\r
--- /dev/null
+/*****************************************************************************
+* Copyright (C), 2018, MEMSIC Inc.
+* File Name : MemsicAlgo.h
+* Author : MEMSIC AE Algoritm Team
+* Description : This file is the head file of MemsicAlgo.lib. It provides the
+* interface function declarations of the lib.
+* History : 1. Data : 20180801
+* 2. Author : YGP
+* 3. Modification :
+*****************************************************************************/
+#ifndef _MEMSICALGORITHM_H_
+#define _MEMSICALGORITHM_H_
+
+#define ANDROID_PLATFORM 1
+#define EVB_PLATFORM 2
+#define WINDOWS_PLATFORM 3
+#define PLATFORM EVB_PLATFORM
+
+#if((PLATFORM == ANDROID_PLATFORM)||(PLATFORM == EVB_PLATFORM))
+#define DLL_API
+#define _stdcall
+#elif(PLATFORM == WINDOWS_PLATFORM)
+#define DLL_API extern "C" __declspec(dllexport)
+#endif
+
+#if(PLATFORM == ANDROID_PLATFORM)
+#include "MemsicConfig.h"
+#include <utils/Log.h> //ALOGE
+#endif
+
+#ifndef MEMSIC_ALGORITHM_DATA_TYPES
+#define MEMSIC_ALGORITHM_DATA_TYPES
+typedef signed char int8; // signed 8-bit number (-128 to +127)
+typedef unsigned char uint8; // unsigned 8-bit number (+0 to +255)
+typedef signed short int16; // signed 16-bt number (-32,768 to +32,767)
+typedef unsigned short uint16; // unsigned 16-bit number (+0 to +65,535)
+typedef signed int int32; // signed 32-bit number (-2,147,483,648 to +2,147,483,647)
+typedef unsigned int uint32; // unsigned 32-bit number (+0 to +4,294,967,295)
+#endif
+
+#if(PLATFORM == ANDROID_PLATFORM)
+/*******************************************************************************************
+* Function Name : AlgoInitial
+* Description : Initialize the algorithm.
+* Input : None
+* Output : None.
+* Return : 1 --- succeed.
+* -1 --- fail.
+********************************************************************************************/
+int AlgoInitial(void);
+#elif((PLATFORM == EVB_PLATFORM)||(PLATFORM == WINDOWS_PLATFORM))
+/*******************************************************************************************
+* Function Name : InitialAlgorithm
+* Description : Initial the corrected parameters for magnetic sensor.
+* Input : sim[0-8] ---soft iron corrected parameters;
+* mag_para[0-2]---mag offset;
+* mag_para[3] ---mag radius or magnetic field strength;
+* Output : None.
+* Return : 1 --- succeed.
+* -1 --- fail.
+********************************************************************************************/
+DLL_API int _stdcall InitialAlgorithm(float *sim, float *mag_para);
+#endif
+/*******************************************************************************************
+* Function Name : MainAlgorithmProcess
+* Description : Pass the Acc and Mag raw data to the algorithm library.
+* Input : acc[0-2] --- Acceleration raw data of three axis, unit is g;
+* mag[0-2] --- Magnetic raw data of three axis, unit is gauss;
+* enable_cali --- 1 means automatic mag calibration is enabled, 0 not;
+* Output : None.
+* Return : 1 --- succeed.
+* -1 --- fail.
+********************************************************************************************/
+DLL_API int _stdcall MainAlgorithmProcess(float *acc, float *mag, int enable_cali);
+
+/*******************************************************************************************
+* Function Name : GetMagAccuracy
+* Description : Get the accuracy of the calibration algorithm.
+* Input : None
+* Output : None
+* Return : 0 --- Unreliable.
+* : 1 --- Low.
+* : 2 --- Medium.
+* : 3 --- High.
+********************************************************************************************/
+DLL_API int _stdcall GetMagAccuracy(void);
+
+/*******************************************************************************************
+* Function Name : GetMagSaturation
+* Description : Get the magnetic sensor saturation status.
+* Input : None
+* Output : None
+* Return : 0 --- Indicate that magnetic sensor works normally.
+* : 1 --- Indicate that magnetic sensor is saturated, need to do SET action.
+********************************************************************************************/
+DLL_API int _stdcall GetMagSaturation(void);
+
+/*******************************************************************************************
+* Function Name : GetCalPara
+* Description : Get the calibrated parameters of magnetic sensor.
+* Input : None
+* Output : cp[0-2] --- magnetic field offset, unit is gauss.
+* cp[3] --- strength of the magnetic field, unit is gauss.
+* Return : 0 --- no need to save the calibrated magnetometer parameter.
+* 1 --- need to save the new reliable calibrated magnetometer parameter.
+********************************************************************************************/
+DLL_API int _stdcall GetCalPara(float *cp);
+
+/*******************************************************************************************
+* Function Name : GetCalMag
+* Description : Get the MEMSIC calibrated magnetic output.
+* Input : None
+* Output : cm[0-2] --- calibrated magnetic sensor data, unit is gauss.
+* Return : debug use
+********************************************************************************************/
+DLL_API int _stdcall GetCalMag(float *cm);
+
+#endif
+
--- /dev/null
+/*****************************************************************************\r
+* Copyright (C), 2018, MEMSIC Inc.\r
+* File Name : MemsicAlgo.h\r
+* Author : MEMSIC AE Algoritm Team\r
+* Description : This file is the head file of MemsicAlgo.lib. It provides the \r
+* interface function declarations of the lib. \r
+* History : 1. Data : 20180424\r
+* 2. Author : Yan Guopu\r
+* 3. Modification : \r
+*****************************************************************************/\r
+#ifndef _MEMSIC_COMPASS_H_\r
+#define _MEMSIC_COMPASS_H_\r
+\r
+#define ANDROID_PLATFORM 1\r
+#define EVB_PLATFORM 2\r
+#define WINDOWS_PLATFORM 3\r
+#define PLATFORM EVB_PLATFORM\r
+\r
+#if((PLATFORM == ANDROID_PLATFORM)||(PLATFORM == EVB_PLATFORM))\r
+#define DLL_API\r
+#define _stdcall\r
+#elif(PLATFORM == WINDOWS_PLATFORM)\r
+#define DLL_API extern "C" __declspec(dllexport)\r
+#endif\r
+\r
+#if(PLATFORM == ANDROID_PLATFORM)\r
+#include <utils/Log.h> //ALOGE\r
+#endif\r
+\r
+#ifndef MEMSIC_COMPASS_DATA_TYPES\r
+#define MEMSIC_COMPASS_DATA_TYPES\r
+// typedef signed char int8_t; // signed 8-bit number (-128 to +127)\r
+// typedef unsigned char uint8_t; // unsigned 8-bit number (+0 to +255)\r
+// typedef signed short int16_t; // signed 16-bt number (-32,768 to +32,767)\r
+// typedef unsigned short uint16_t; // unsigned 16-bit number (+0 to +65,535)\r
+// typedef signed int int32_t; // signed 32-bit number (-2,147,483,648 to +2,147,483,647)\r
+// typedef unsigned int uint32_t; // unsigned 32-bit number (+0 to +4,294,967,295)\r
+#endif\r
+\r
+/*******************************************************************************************\r
+* Function Name : InitialCompassAlgo\r
+* Description : Initial the filter coeficient for the compass filter.\r
+* Input : sim[0-8] ---soft iron corrected parameters;\r
+* mag_para[0-2]---mag offset;\r
+* mag_para[3] ---mag radius or magnetic field strength;\r
+* Output : None.\r
+* Return : 1 --- succeed.\r
+* -1 --- fail.\r
+********************************************************************************************/\r
+DLL_API int _stdcall InitialCompassAlgo(float fc);\r
+\r
+/*******************************************************************************************\r
+* Function Name : GetCalOri\r
+* Description : Get the MEMSIC calibrated orientation vector.\r
+* Input : acc[0-2] --- Accelerometer data of three axis, unit is gauss.\r
+* : mag[0-2] --- Magnetic raw data of three axis, unit is gauss.\r
+* Output : co[0-2] --- orientation data, azimuth, pitch, roll, unit is degree.\r
+* Return : 1 --- succeed.\r
+* -1 --- fail.\r
+********************************************************************************************/\r
+DLL_API int _stdcall GetCalOri(float *acc, float *mag, float *co);\r
+\r
+#endif\r
+\r
+++ /dev/null
-#include "Customer.h"\r
-#include "MMC5603.h" \r
-\r
-float magnetic_field_x;\r
-float magnetic_field_y;\r
-float magnetic_field_z;\r
-\r
-int test_mmc5603(void)\r
-{\r
- /* Magnetic field vector, unit is gauss */\r
- float mag_raw_data[3] = {0.0}; \r
- \r
- /* Enable the sensor. */\r
- MMC5603_Enable(); \r
- int count = 10;\r
- while(count)\r
- { \r
- /* Get the MMC5603 data, unit is gauss */\r
- MMC5603_GetData(mag_raw_data); \r
-\r
- magnetic_field_x = mag_raw_data[0]; //unit is gauss\r
- magnetic_field_y = mag_raw_data[1]; //unit is gauss\r
- magnetic_field_z = mag_raw_data[2]; //unit is gauss\r
- count-- ;\r
- /* Sampling interval is 20ms, and the sampling rate is 50Hz. */\r
-\r
- MMC_LOG("mag 5603 x %.03f, y %.03f , z %.03f \r\n",magnetic_field_x,magnetic_field_y,magnetic_field_z);\r
- mmc5603_Delay_Ms(20);\r
- }\r
- MMC5603_Disable();\r
- return 0;\r
-}\r
#include "pm_control.h"
#include "MMC5603.h"
#include "Customer.h"
+#include "mag_service.h"
#define ARRAY_COUNT(array) (sizeof(array) / sizeof(array[0]))
#define MMC5603_MAX_ARGC 8
return MMC5603_SUCCESS;
}
-extern int test_mmc5603(void);
-static uint32_t mmc5603_do_test(uint8_t *para, uint32_t paraLen, char *strCommonCmd)
+static uint32_t mmc5603_start_test(uint8_t *para, uint32_t paraLen, char *strCommonCmd)
{
UNUSED(strCommonCmd);
- test_mmc5603();
+ UNUSED(paraLen);
+ UNUSED(para);
+ do_mag_service_check_msg(MAG_SERVICE_CMD_START_CHECK);
+ return ERRCODE_SUCC;
+}
+static uint32_t mmc5603_stop_test(uint8_t *para, uint32_t paraLen, char *strCommonCmd)
+{
+ UNUSED(strCommonCmd);
+ UNUSED(paraLen);
+ UNUSED(para);
+ do_mag_service_check_msg(MAG_SERVICE_CMD_STOP_CHECK);
return ERRCODE_SUCC;
}
-
static const at_cmd_table_t g_mmc5603_cmd[] = {
- { (char *)"AT^MMC5603TEST", mmc5603_do_test, (char *)"aac enable" },
+ { (char *)"AT^MMC5603TESTSTART", mmc5603_start_test, (char *)"1" },
+ { (char *)"AT^MMC5603TESTSTOP", mmc5603_stop_test, (char *)"1" },
};
at_cmd_table_t *get_mmc5603_cmd_table(uint32_t *cmd_count)
--- /dev/null
+/**
+ * Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved. \n
+ *
+ * Description: Provides at cmd register func \n
+ * Author: @CompanyNameTag \n
+ * History: \n
+ * 2022-07-20, Create file. \n
+ */
+#ifndef MMC5603_HAL_H
+#define MMC5603_HAL_H
+
+#include <stdint.h>
+#include <stdio.h>
+#include "errcode.h"
+#include "soc_osal.h"
+#include "at_cmd_api.h"
+
+#ifdef __cplusplus
+#if __cplusplus
+extern "C" {
+#endif /* __cplusplus */
+#endif /* __cplusplus */
+
+int mmc5603_stop(void);
+int mmc5603_check(void);
+int mmc5603_start(void);
+
+#ifdef __cplusplus
+#if __cplusplus
+}
+#endif /* __cplusplus */
+#endif /* __cplusplus */
+
+#endif
--- /dev/null
+/* This sample code teaches developer how to operate the MEMSIC alogrithm library\r
+ * to get Yaw, Pitch and Roll respectively. if developer want to use it as a part\r
+ * of his codes, he need to declare and define 3 functions by himself:\r
+ * ReadPara;\r
+ * Savepara;\r
+ * please NOTE it is ONLY a sample code and can be changed freely by developers.\r
+ */\r
+ \r
+#include "MemsicAlgo.h"\r
+#include "MemsicCompass.h"\r
+#include "Customer.h"\r
+#include "MMC5603.h" \r
+\r
+#ifdef ACC_LIS2DOC\r
+#include "acc_service.h"\r
+#endif\r
+float magnetic_field_x;\r
+float magnetic_field_y;\r
+float magnetic_field_z;\r
+\r
+#define A_LAYOUT 0\r
+#define M_LAYOUT 5\r
+\r
+\r
+\r
+/* These variables are used to save the magnetic sensor calibrated data. */ \r
+float calMagX, calMagY, calMagZ; \r
+\r
+/* These variables are used to save the calibrated orientation output. */ \r
+float fAzimuth, fPitch, fRoll;\r
+\r
+/* This variable is used to save the calibration accuracy. */ \r
+int iAccuracy;\r
+\r
+/* Read saved calibration parameters. These para is saved in somewhere that can not disappear when power-off\r
+ * ReadPara function should be create by customer.If customer can not implement this function, should comment it out\r
+ * If there is no parameter saved, ReadPara() should return -1, else return 1;\r
+ * If there is no para saved, pass the default value to the algorithm library\r
+ */ \r
+int ReadPara(float *p);\r
+\r
+/* Save calibration parameters in somewhere that can not lose after power-off. \r
+ * When the system power on next time, need to read this parameters by the function ReadPara() for algorithm initial.\r
+ * If save parameter successfully, return 1, else return -1;\r
+ */\r
+int SavePara(float *p);\r
+\r
+\r
+/**\r
+ * @brief Convert the sensor coordinate to right-front-up coordinate system;\r
+ */\r
+void acc_coordinate_raw_to_real(int layout, float *in, float *out);\r
+\r
+/**\r
+ * @brief Convert the sensor coordinate to right-front-up coordinate system;\r
+ */\r
+void mag_coordinate_raw_to_real(int layout, float *in, float *out);\r
+\r
+/**\r
+ * 校准数据\r
+ */\r
+static float g_MagPara[4] = {0.0f};\r
+\r
+/*******************************************************************************\r
+* Function Name : main\r
+* Description : the main function\r
+*******************************************************************************/\r
+\r
+ \r
+ /* This variable is used to save calibrated mag para that need to be saved in system file */\r
+static float saveData[4] = {0.0f};\r
+ \r
+int mmc5603_start(void)\r
+{\r
+ int i;\r
+ /* magnetic sensor soft iron calibration matrix, default is unit matrix */\r
+ float mag_smm[9] = { 1.0f, 0.0f, 0.0f, \\r
+ 0.0f, 1.0f, 0.0f, \\r
+ 0.0f, 0.0f, 1.0f};\r
+ \r
+ /* default hard iron offset and magnetic field strength*/ \r
+ float mag_hmm[4] = {0.0f,0.0f,0.0f,0.5f}; \r
+ /* Read saved calibration parameters. These para is saved in somewhere that can not disappear when power-off\r
+ * ReadPara function should be create by customer.If customer can not implement this function, should comment it out\r
+ * If there is no parameter saved, ReadPara() should return -1, else return 1;\r
+ * If there is no para saved, pass the default value to the algorithm library\r
+ */\r
+ if(ReadPara(saveData)==1){ \r
+ for(i=0;i<4;i++){\r
+ mag_hmm[i] = saveData[i]; \r
+ }\r
+ } \r
+ \r
+ /* Initial the acc, mag, and calibrated parameters \r
+ * if already saved the calibrated offset and radius last time, read it out and init the magOffset and magRadius\r
+ */\r
+ InitialAlgorithm(mag_smm, mag_hmm); \r
+ \r
+ /* Enable the sensor. */\r
+ MMC5603_Enable(); \r
+ return 0;\r
+}\r
+int mmc5603_check(void)\r
+{\r
+ int i;\r
+ \r
+ /* This variable is used to store the accelerometer and magnetometer raw data.\r
+ * please NOTE that the data is going to store here MUST has been transmitted \r
+ * to match the Right-Handed coordinate sytem already.\r
+ */\r
+ \r
+ float acc_raw_data[3] = {0.0f}; //accelerometer field vector, unit is g\r
+ float acc_real_data[3] = {0.0f}; \r
+ \r
+ float mag_raw_data[3] = {0.0f}; //magnetic field vector, unit is gauss\r
+ float mag_real_data[3] = {0.0f};\r
+ \r
+ /* This variable is used to judge whether or not the developer \r
+ * should save the parameters in one place where will be read \r
+ * by the algorithm every time when the device restart.\r
+ * save_flag is a flag to if we need to save algorithm parameter into the system file.\r
+ */\r
+ int save_flag=0;\r
+ /* Get the acc raw data, unit is g*/\r
+ #ifdef ACC_LIS2DOC\r
+ lis2doc_read_data_single(&acc_raw_data[0],&acc_raw_data[1],&acc_raw_data[2]);\r
+ #endif\r
+ //acc_raw_data[0] = ; \r
+ //acc_raw_data[1] = ; \r
+ //acc_raw_data[2] = ;\r
+\r
+ /* This variable is used to save the calibrated mag sensor XYZ output. */\r
+ float caliMag[3] = {0.0f};\r
+ \r
+ /* This variable is used to save the calibrated orientation data. */\r
+ float caliOri[3] = {0.0f}; \r
+ \r
+ /* This variable is used to save calibrated mag sensor parameters */\r
+ float caliMagPara[4] = {0.0f}; \r
+ /* convert the coordinate system */ \r
+ acc_coordinate_raw_to_real(A_LAYOUT, acc_raw_data, acc_real_data); \r
+ \r
+ /* Get the MMC5603 mag raw data, unit is gauss */\r
+ MMC5603_GetData(mag_raw_data);\r
+\r
+ /* Convert the coordinate system */ \r
+ mag_coordinate_raw_to_real(M_LAYOUT, mag_raw_data, mag_real_data); \r
+\r
+ /* Below functions are algorithm interface. \r
+ * input acc, mag data into algorithm\r
+ * make sure that acc and mag XYZ data meet the right-hand(right-front-up) coordinate system\r
+ */\r
+ MainAlgorithmProcess(acc_real_data, mag_real_data, 1); \r
+ \r
+ /* Get calibrated mag data */\r
+ GetCalMag(caliMag);\r
+ \r
+ /* Calibrated magnetic sensor output, unit is gauss */\r
+ calMagX = caliMag[0];\r
+ calMagY = caliMag[1];\r
+ calMagZ = caliMag[2];\r
+ PRINT("== Mag x %.02F,y %.02F , z %.02F\r\n",\r
+ calMagX,//高斯X\r
+ calMagY,//高斯Y\r
+ calMagZ//高斯Z\r
+ );\r
+ /* Get orientation vector */\r
+ if (GetCalOri(acc_real_data, caliMag, caliOri) == 1 )\r
+ {\r
+\r
+ /* Get the accuracy of the algorithm */\r
+ iAccuracy = GetMagAccuracy();\r
+ \r
+ /* Get the fAzimuth Pitch Roll for the eCompass */\r
+ fAzimuth = caliOri[0];\r
+ fPitch = caliOri[1];\r
+ fRoll = caliOri[2]; \r
+ PRINT("iAccuracy %d== Acc Azimuth %.02F,Pitch %.02F , Roll %.02F\r\n", \r
+ iAccuracy,//可信度\r
+ fAzimuth, //水平方向角,左转右转\r
+ fPitch,//上下俯仰角\r
+ fRoll//左右翻滚角\r
+ );\r
+ \r
+ }\r
+\r
+ \r
+ /* Get the SET Flag from algorithm */ \r
+ if(GetMagSaturation()) \r
+ {\r
+ //MEMSIC_Magnetic_Sensor_SET(); //Do SET action\r
+ MMC5603_SET();\r
+ }\r
+ \r
+ /* Get corrected mag data */\r
+ save_flag = GetCalPara(caliMagPara);\r
+ \r
+ if(save_flag == 1)\r
+ {\r
+ /* Get the offset and radius that need to be saved in system file */ \r
+ for(i=0;i<4;i++)\r
+ {\r
+ saveData[i] = caliMagPara[i]; \r
+ } \r
+ /* Save the calpara buffer into the system file */\r
+ /* This function should be create by customer.If customer can not implement this function, should comment it out */ \r
+ SavePara(saveData); \r
+ PRINT("save para \r\n"); \r
+ }\r
+\r
+ /* Sampling interval is 20ms. */\r
+ // mmc5603_Delay_Ms(20);\r
+ \r
+ return 0;\r
+}\r
+\r
+/* Read saved calibration parameters. These para is saved in somewhere that can not disappear when power-off\r
+ * ReadPara function should be create by customer.If customer can not implement this function, should comment it out\r
+ * If there is no parameter saved, ReadPara() should return -1, else return 1;\r
+ * If there is no para saved, pass the default value to the algorithm library\r
+ */ \r
+int ReadPara(float *p)\r
+{\r
+ int i;\r
+ /* \r
+ .\r
+ . Need to be implemented by user. \r
+ .\r
+ */ \r
+ \r
+ for(i=0;i<4;i++){\r
+ p[i] = g_MagPara[i]; \r
+ }\r
+ return 1;\r
+}\r
+\r
+/* Save calibration parameters in somewhere that can not lose after power-off. \r
+ * When the system power on next time, need to read this parameters by the function ReadPara() for algorithm initial.\r
+ * If save parameter successfully, return 1, else return -1;\r
+ */\r
+int SavePara(float *p)\r
+{ \r
+ /* \r
+ .\r
+ . Need to be implemented by user. \r
+ .\r
+ */\r
+ int i=0;\r
+ for(i=0;i<4;i++){\r
+ g_MagPara[i] = p[i]; \r
+ }\r
+ \r
+ return 1;\r
+}\r
+\r
+/* Convert the sensor coordinate to right-front-up coordinate system;\r
+ */\r
+void acc_coordinate_raw_to_real(int layout, float *in, float *out)\r
+{\r
+ switch (layout) {\r
+ case 0:\r
+ out[0] = in[0];\r
+ out[1] = in[1];\r
+ out[2] = in[2];\r
+ break;\r
+ case 1:\r
+ out[0] = -in[1];\r
+ out[1] = in[0];\r
+ out[2] = in[2];\r
+ break;\r
+ case 2:\r
+ out[0] = -in[0];\r
+ out[1] = -in[1];\r
+ out[2] = in[2];\r
+ break;\r
+ case 3:\r
+ out[0] = in[1];\r
+ out[1] = -in[0];\r
+ out[2] = in[2];\r
+ break;\r
+ case 4:\r
+ out[0] = in[1];\r
+ out[1] = in[0];\r
+ out[2] = -in[2];\r
+ break;\r
+ case 5:\r
+ out[0] = -in[0];\r
+ out[1] = in[1];\r
+ out[2] = -in[2];\r
+ break;\r
+ case 6:\r
+ out[0] = -in[1];\r
+ out[1] = -in[0];\r
+ out[2] = -in[2];\r
+ break;\r
+ case 7:\r
+ out[0] = in[0];\r
+ out[1] = -in[1];\r
+ out[2] = -in[2];\r
+ break;\r
+ default:\r
+ out[0] = in[0];\r
+ out[1] = in[1];\r
+ out[2] = in[2];\r
+ break;\r
+ }\r
+}\r
+/* Convert the sensor(MMC3630KJ) coordinate to right-front-up coordinate system;\r
+ */\r
+void mag_coordinate_raw_to_real(int layout, float *in, float *out)\r
+{\r
+ switch (layout) {\r
+ case 0:\r
+ out[0] = in[0];\r
+ out[1] = in[1];\r
+ out[2] = in[2];\r
+ break;\r
+ case 1:\r
+ out[0] = -in[1];\r
+ out[1] = in[0];\r
+ out[2] = in[2];\r
+ break;\r
+ case 2:\r
+ out[0] = -in[0];\r
+ out[1] = -in[1];\r
+ out[2] = in[2];\r
+ break;\r
+ case 3:\r
+ out[0] = in[1];\r
+ out[1] = -in[0];\r
+ out[2] = in[2];\r
+ break;\r
+ case 4:\r
+ out[0] = in[1];\r
+ out[1] = in[0];\r
+ out[2] = -in[2];\r
+ break;\r
+ case 5:\r
+ out[0] = -in[0];\r
+ out[1] = in[1];\r
+ out[2] = -in[2];\r
+ break;\r
+ case 6:\r
+ out[0] = -in[1];\r
+ out[1] = -in[0];\r
+ out[2] = -in[2];\r
+ break;\r
+ case 7:\r
+ out[0] = in[0];\r
+ out[1] = -in[1];\r
+ out[2] = -in[2];\r
+ break; \r
+ default:\r
+ out[0] = in[0];\r
+ out[1] = in[1];\r
+ out[2] = -in[2];\r
+ break;\r
+ }\r
+}\r
+float mag_service_get_fAzimuth(void)\r
+{\r
+ return fAzimuth ;\r
+}\r
+\r
+int mmc5603_stop(void)\r
+{\r
+ MMC5603_Disable();\r
+ return 0;\r
+}\r
--- /dev/null
+/**
+ * Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved. \n
+ *
+ * Description: Test adc source \n
+ * Author: @CompanyNameTag \n
+ * History: \n
+ * 2022-08-16, Create file. \n
+ */
+
+#include "adc.h"
+#define TEST_PARAM_ARGC_1 1
+#define TEST_PARAM_ARGC_2 2
+#define TEST_PARAM_ARGC_3 3
+#define TEST_PARAM_ARGC_4 4
+#define TEST_PARAM_ARGC_5 5
+#define TEST_PARAM_ARGC_6 6
+#define TEST_PARAM_ARGC_7 7
+#define TEST_PARAM_4_BYTES 4
+#define TEST_PARAM_8_BYTES 8
+typedef enum {
+ SUITE_OK = 0,
+ SUITE_UNKNOWN_FUNCTION = -1,
+ SUITE_ERROR_TIMED_OUT = -2,
+ SUITE_ERROR_BAD_PARAMS = -3,
+ SUITE_ERROR_PIN_ALLOCATION = -4,
+ SUITE_ERROR_PIN_DEALLOCATION = -5,
+ SUITE_ERROR_UNEXPECTED_INTERRUPT = -6,
+ SUITE_ALLOC_FAILED = -7,
+ SUITE_CONFIG_FAILED = -8,
+ SUITE_TEST_FAILED = -254,
+} magservice_error_e;
+
+#if defined(CONFIG_ADC_SUPPORT_AFE)
+
+#error CONFIG_ADC_SUPPORT_AFE
+
+#include "hal_adc_v152.h"
+#include "hal_adc_v152_regs_op.h"
+#else
+#include "hal_adc_v151.h"
+#include "hal_adc_v151_regs_op.h"
+#endif
+
+#include "adc_porting.h"
+#include "pinctrl.h"
+#include "debug_print.h"
+#include "soc_osal.h"
+#include "tcxo.h"
+#include "irmalloc.h"
+#include "errcode.h"
+#include "common_def.h"
+
+#include "chip_core_irq.h"
+#include "chip_io.h"
+#include "gpio.h"
+#include "pm_veto.h"
+
+#include "rtc.h"
+#include "timer.h"
+#include "systick.h"
+
+
+static bool g_batter_service_initialled = false;
+
+#include "tcxo.h"
+
+#include "cmsis_os2.h"
+#include "input_app.h"
+#include "mmc5603_hal.h"
+#include "mag_service.h"
+
+
+/***
+ * 其他cmd在Header里定义,对外开放
+*/
+#define MAG_SERVICE_CMD_TIMER_CHECK 0x11
+
+osTimerId_t g_mag_service_timer = NULL;
+
+static bool g_bat_timer_is_running = false;
+#define MAG_CHECK_MS 200
+static unsigned long g_app_queue;
+
+static bool mag_service_running_stat = false;
+static void mag_service_check_timer_callback(void* data);
+
+static void mag_service_timer_start_check(uint32_t rtc_ms)
+{
+
+ if (g_bat_timer_is_running ) osTimerStop(g_mag_service_timer);
+ if (mag_service_running_stat == true) osTimerStart(g_mag_service_timer, rtc_ms);
+ g_bat_timer_is_running = true;
+
+}
+void do_mag_service_check_msg(int cmd);
+
+static void mag_service_check_timer_callback(void * data)
+{
+ unused(data);
+
+ g_bat_timer_is_running = false;
+
+ if(mag_service_running_stat == true){
+ mmc5603_check(); //此处只能直接加到timer callback中,采用queue的话,新能跟不上,系统资源会挂掉。
+ mag_service_timer_start_check(MAG_CHECK_MS);
+ }
+ // do_mag_service_check_msg(MAG_SERVICE_CMD_TIMER_CHECK);
+ // uapi_tcxo_delay_ms(20);
+
+
+
+}
+void uapi_mag_service_deinit(void)
+{
+ /* Stop the time and clear the pin map */
+ osTimerStop(g_mag_service_timer);
+ osTimerDelete(g_mag_service_timer);
+
+ g_bat_timer_is_running = false;
+ g_mag_service_timer = NULL;
+}
+
+
+
+void do_mag_service_check_msg(int cmd)
+{
+ int ret;
+
+ common_notify_mail_t mail = {0};
+ mail.comm.app = cmd;
+ ret = osal_msg_queue_write_copy(g_app_queue, (void *)&mail,
+ sizeof(common_notify_mail_t), 0);
+ if (ret != OSAL_SUCCESS) {
+ PRINT("Error mag Check MSG 0x%02X send failed! err=0x%x! \r\n",cmd, ret);
+ }
+
+}
+
+static void mag_service_check_task(void const *arg)
+{
+ unused(arg);
+ int32_t ret;
+ common_notify_mail_t mail;
+ uint32_t msgsize = (uint32_t)sizeof(common_notify_mail_t);
+
+ while (1) {
+ ret = osal_msg_queue_read_copy(g_app_queue, (void *)&mail, &msgsize,
+ OSAL_MSGQ_WAIT_FOREVER);
+ if (ret != OSAL_SUCCESS) {
+ continue;
+ }
+
+ if (mail.comm.app == MAG_SERVICE_CMD_TIMER_CHECK) {
+ // mag_service_check_and_enable_charge();
+ // mmc5603_check();
+ PRINT("MAG_SERVICE_CMD_TIMER_CHECK\r\n");
+ }else if (mail.comm.app == MAG_SERVICE_CMD_START_CHECK){
+ mag_service_running_stat = true;
+ mmc5603_start();
+ mag_service_timer_start_check(MAG_CHECK_MS);
+ }else if (mail.comm.app == MAG_SERVICE_CMD_STOP_CHECK){
+ mag_service_running_stat = false;
+ osTimerStop(g_mag_service_timer);
+ mmc5603_stop();
+ }
+ }
+}
+
+errcode_t uapi_mag_service_init(void)
+{
+ if (osal_msg_queue_create("mag_service_queue", APP_BOARD_MSG_COUNT, &g_app_queue,
+ 0, sizeof(common_notify_mail_t)) != ERRCODE_SUCC) {
+ PRINT("[mag][service] app create mail fail\n");
+ return ERRCODE_FAIL;
+ }
+
+
+ osal_task *task_handle = osal_kthread_create((osal_kthread_handler)mag_service_check_task, NULL,
+ "mag_service_service", APP_BOARD_TASK_SIZE);
+ if (task_handle == NULL) {
+ osal_msg_queue_is_full(g_app_queue);
+ PRINT("create mag service thread fail!\r\n");
+ return ERRCODE_FAIL;
+ }
+
+ // osal_kthread_set_priority(task_handle, APP_BOARD_TASK_PRIO);
+ osal_kthread_set_priority(task_handle, 10);
+
+ g_mag_service_timer = osTimerNew((osTimerFunc_t)mag_service_check_timer_callback, osTimerPeriodic, NULL, NULL);
+
+
+ return ERRCODE_SUCC;
+}
+
+// void mag_service_service_resume(void)
+// {
+// PRINT("mag_service_service resume!\r\n");
+// mag_service_check_timer_callback(0);
+// }
+// void mag_service_service_suspend(void)
+// {
+// PRINT("mag_service_service suspend!\r\n");
+// }
\ No newline at end of file
--- /dev/null
+/**
+ * Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved. \n
+ *
+ * Description: Test adc header \n
+ * Author: @CompanyNameTag \n
+ * History: \n
+ * 2022-08-16, Create file. \n
+ */
+
+#ifndef MAG_SERVICE_H__
+#define MAG_SERVICE_H__
+
+#ifdef __cplusplus
+#if __cplusplus
+extern "C" {
+#endif /* __cplusplus */
+#endif /* __cplusplus */
+
+#include "stdint.h"
+#include "errcode.h"
+
+
+#define MAG_SERVICE_CMD_START_CHECK 0x12
+#define MAG_SERVICE_CMD_STOP_CHECK 0x13
+
+errcode_t uapi_mag_service_init(void);
+void uapi_mag_service_deinit(void);
+/**
+ * 测试指令 参数cmd 选项: MAG_SERVICE_CMD_START_CHECK,MAG_SERVICE_CMD_STOP_CHECK
+*/
+void do_mag_service_check_msg(int cmd);
+
+float mag_service_get_fAzimuth(void);
+
+#ifdef __cplusplus
+#if __cplusplus
+}
+#endif /* __cplusplus */
+#endif /* __cplusplus */
+
+#endif
\ No newline at end of file
*/
errcode_t uapi_i2c_master_init(i2c_bus_t bus, uint32_t baudrate, uint8_t hscode);
+errcode_t i2c_master_init_check(i2c_bus_t bus, uint32_t baudrate, uint8_t hscode);
/**
* @if Eng
* @brief I2C Master writes a buffer to target slave. There are three transfer modes:
LOSCFG_BASE_CORE_TSK_MONITOR=y
LOSCFG_TASK_STACK_STATIC_ALLOCATION=y
LOSCFG_TASK_STACK_DYNAMIC_ALLOCATION=y
-LOSCFG_BASE_CORE_TSK_LIMIT=32
+LOSCFG_BASE_CORE_TSK_LIMIT=48
LOSCFG_BASE_CORE_TSK_MIN_STACK_SIZE=1024
LOSCFG_BASE_CORE_TSK_DEFAULT_STACK_SIZE=2048
LOSCFG_BASE_CORE_TSK_SWTMR_STACK_SIZE=2048