#include "usr_config.h"
#include "hal_battery.h"
#include "nrf_drv_saadc.h"
#include "bsp_time.h"
#include "system.h"
#include "hal_led.h"
#include "hal_imu.h"
#include "app_overturn.h"
#include "app_wearshoes.h"

#define acc0Value  3000
#define acc1iValue -1600
#define acc1aValue 0
#define acc2iValue -1500
#define acc2aValue 400
				
/************************ 踮脚显示电量 ***********************************/
static uint8_t flag_move =0;

//void app_BatDispaly_Process_N(void)        
//{
//		int16_t acc[3];
//		static uint32_t cnt = 0;
//					
//		if(app_wearshoes_is_wearshoes()>0) return;//停止状态
//					
//		IMU_Get_Index_Front_Low_Power_Data(acc, NULL, NULL, IMU_Get_Front_Low_Power_Data_GroupNum());
////		SEGGER_RTT_printf(0,"0:acc[0]=%d,acc[1]=%d,acc[2]=%d\n",acc[0],acc[1],acc[2]);
//		if(acc[2] > acc1iValue){
//						cnt++;
//						if(cnt==1){ 
//										if(GetBatteryPersent()>20){
//										LED_SetColor(LED_OVERTURN,COLOR_GREEN);
//										}else{
//														LED_SetColor(LED_OVERTURN,COLOR_RED);
//										}
//										LED_Start(LED_OVERTURN);
//										Process_SetHoldOn(app_BatDispaly_Process_N,1);
//						}
//						if(cnt==100){
//										LED_Stop(LED_OVERTURN);
//										Process_SetHoldOn(app_BatDispaly_Process_N,0);
//						}
//		}else{
//						if(cnt>0){ cnt = 0;
//										LED_Stop(LED_OVERTURN);
//										Process_SetHoldOn(app_BatDispaly_Process_N,0);
//						}
//						if(flag_move == 1){
//							 flag_move =0;
//							 LED_Stop(LED_OVERTURN);
//							 Process_SetHoldOn(app_BatDispaly_Process_N,0);
//						}
//		}
//}

//void app_BatDispaly_Process(void)
//{
//			int16_t acc[3];
//			static uint32_t cnt = 0;
//			static int16_t         acc0 = acc0Value;
//			static int16_t         acc1i = acc1iValue;
//			static int16_t         acc1a = acc1aValue;
//			static int16_t         acc2i = acc2iValue;
//			static int16_t         acc2a = acc2aValue;
//			
//			if(1 == IMU_GetSensorEnable()) {
//				LED_Stop(LED_OVERTURN);
//				return;//
//			}
//			if(app_wearshoes_is_wearshoes()==0) return;//走路状态
//			
//			IMU_Get_Index_Front_Low_Power_Data(acc, NULL, NULL, IMU_Get_Front_Low_Power_Data_GroupNum());
////      SEGGER_RTT_printf(0,"1:acc[0]=%d,acc[1]=%d,acc[2]=%d\n",acc[0],acc[1],acc[2]);
//			if(acc[0] < acc0 && acc[1] > acc1i && acc[1] < acc1a && acc[2] < acc2a && acc[2] > acc2i){
//							cnt++;
//							if(cnt==10){ 
//											if(GetBatteryPersent()>20){
//											LED_SetColor(LED_OVERTURN,COLOR_GREEN);
//											}else{
//															LED_SetColor(LED_OVERTURN,COLOR_RED);
//											}
//											LED_Start(LED_OVERTURN);
//											Process_SetHoldOn(app_BatDispaly_Process,1);
//											acc0 = acc0Value;
//											acc1i = acc1iValue;
//											acc1a = acc1aValue;
//											acc2i = acc2iValue;
//											acc2a = acc2aValue;
//							}
//							if(cnt==100){
//											LED_Stop(LED_OVERTURN);
//											Process_SetHoldOn(app_BatDispaly_Process,0);
//											acc0 = acc0Value-200;
//											acc1i = acc1iValue;
//											acc1a = acc1aValue;
//											acc2i = acc2iValue;
//											acc2a = acc2aValue;
//							}
//			}else{
//							if(cnt>0){ cnt = 0;
//											LED_Stop(LED_OVERTURN);
//											Process_SetHoldOn(app_BatDispaly_Process,0);
//											acc0 = acc0Value;
//											acc1i = acc1iValue;
//											acc1a = acc1aValue;
//											acc2i = acc2iValue;
//											acc2a = acc2aValue;
//							}
//							if(flag_move == 0){
//								 flag_move =1;
//								 LED_Stop(LED_OVERTURN);
//								 Process_SetHoldOn(app_BatDispaly_Process,0);
//								 acc0 = acc0Value;
//								 acc1i = acc1iValue;
//								 acc1a = acc1aValue;
//								 acc2i = acc2iValue;
//								 acc2a = acc2aValue;
//							}
//			}
//}


void app_overturn_Init(void)
{
//		Process_Start(100,"BatDispaly",app_BatDispaly_Process);
//		Process_Start(100,"BatDispaly_N",app_BatDispaly_Process_N);
}