#include "usr.h"
#include "system.h"
#include "bsp_time.h"
#include "nrf_delay.h"

//Add your code here...
#include "twi_master.h"
#include "hal_ser_imu_mode_manage.h"
#include "hal_ble_client.h"
#include "hal_ble_host.h"
#include "hal_mt.h"
#include "hal_battery.h"
#include "hal_led.h"
#include "app_overturn.h"
#include "app_charge.h"
#include "app_power.h"
#include "app_client.h"
#include "app_host.h"
#include "app_flash.h"
#include "app_step.h"
#include "app_game.h"
#include "hal_ble_uart0.h"
#include "app_config.h"
#include "app_ota.h"
#include "app_connect_manage.h"
#include "app_organ.h"
#include "ble_comm.h"
#include "ble_gap.h"
#include "exception.h"
#include "bsp_pwm.h"
#include "bsp_wdt.h"
#include "bsp_adc.h"
#include "tool.h"
#include "app_ImuCalibration.h"
#include "hal_wearshoes.h"
#include "app_math.h"
#include "app_losspack.h"
#include "app_pair.h"
#include "app_switchimu.h"
#include "app_self_checking.h"
#include "exception.h"
#include "tool.h"
#include "app_data_transfer.h"
#include "hal_scan_manage.h"
#include "app_safe.h"
#include "hal_detect_left_right.h"
#include "nrf_drv_gpiote.h"
#include "fml_single_line_simplex.h"

void USR_SetName(void)
{
	char buf[16];
	memset(buf,0,16);

	if(mFlash.isHost){	//
		#if BleNameHoldOn_ENANBLE
		slave_set_adv_name((char *) LEFT_NAME,sizeof(LEFT_NAME));
		SEGGER_RTT_printf(0,"scanName(%d):%s\n",sizeof(RIGHT_NAME),RIGHT_NAME);
	  host_set_scan_name((char *)RIGHT_NAME,sizeof(RIGHT_NAME));
		#else
		if(mFlash.mClient.isConfig=='C'){ //
			sprintf(buf,"%02X%02X%02X%02X%02X%02X",mFlash.macHost[0],mFlash.macHost[1],mFlash.macHost[2],mFlash.mClient.macAddr[3],mFlash.mClient.macAddr[4],mFlash.mClient.macAddr[5]);
			SEGGER_RTT_printf(0,"scanName(%d):%s\n",strlen(buf),buf);
			host_set_scan_name(buf,strlen(buf));
		}
		#endif
	}else{ //
		#if BleNameHoldOn_ENANBLE 
        slave_set_adv_name((char *)RIGHT_NAME,sizeof(RIGHT_NAME));
        SEGGER_RTT_printf(0,"AdvName(%d):%s\n",sizeof(RIGHT_NAME),RIGHT_NAME);
		    host_set_scan_name((char *)LAST_NAME,sizeof(LAST_NAME));
		#else
		if(mFlash.mClient.isConfig=='C'){ //
			sprintf(buf,"%02X%02X%02X%02X%02X%02X",mFlash.macHost[0],mFlash.macHost[1],mFlash.macHost[2],mFlash.mClient.macAddr[3],mFlash.mClient.macAddr[4],mFlash.mClient.macAddr[5]);
			SEGGER_RTT_printf(0,"advName(%d):%s\n",strlen(buf),buf);
			slave_set_adv_name(buf,strlen(buf));
		}
		host_set_scan_name((char *)"12321321312",sizeof("12321321312"));
		#endif
		
	}
}


__weak void usr1_Init(void)
{
	USR_SetName();
	slave_init(BLE_Client_Push);
	host_init(BLE_Host_Push);
}

void PRE_Init(void)
{
//	watchdog_init();
//	feed_watchdog();
	nrf_gpio_cfg_input(21,NRF_GPIO_PIN_PULLUP);//3?¦Ì?¨°y??¨¦?¨¤-
	PWR_Init();
	LED_Init();
//	MT_Init();
	Flash_Initialize();
  Exception_Init();
	usr1_Init();
	
	
	
//	nrf_gpio_cfg(
//        PIN_CHARGING,
//        NRF_GPIO_PIN_DIR_OUTPUT,
//        NRF_GPIO_PIN_INPUT_CONNECT,
//        NRF_GPIO_PIN_NOPULL,
//        NRF_GPIO_PIN_D0H1,
//        NRF_GPIO_PIN_NOSENSE);
//	
//	nrf_gpio_cfg_watcher(PIN_CHARGING);
//	while(1)
//	{
//		nrf_gpio_pin_set(PIN_CHARGING);
//		nrf_delay_ms(100);
//		nrf_gpio_pin_clear(PIN_CHARGING);
//		nrf_delay_ms(100);
//	}
	
	
	
	
	
	fml_single_line_simplex_Init();
	
	char value = 0;
	int len = 0;
	
	char receive[100];
	
	while(1)
	{
		
//		CHECK_TIMECONSUMING_START;
//		fml_single_line_simplex_transfer(&value,1);
//		CHECK_TIMECONSUMING_END;
//		value++;
//		SEGGER_RTT_printf(0,"value:%d\n",value);
		
		
		len = fml_single_line_simplex_receive(receive, 1) ;
		for(int i=0; i < len; i++)
		{
			SEGGER_RTT_printf(0,"drv_single_line_simplex_receive:%d\n",receive[i]);
		}
			
		 
//		WS2812_DisplayDot(COLOR_BLUE);
//		led_play();
	}
	
	
	
	
	
	
	
	

}

void USR_Init(void)
{
	//Add your code here...
	TIME_Init();
	hal_ser_imu_mode_manage_Init();
	ADC_Initialize();
	
  hal_battery_init();
	BLE_Client_Initialize();
	BLE_Host_Initialize();
	hal_wearshoes_Init();
	hal_ble_scan_Init();
	hal_detect_left_right_Init();
	
	//APP
	app_client_Initialize();
	app_host_Initialize();
	app_overturn_Init();
	app_charge_Init();
	app_step_Init();
	app_game_Init();
	app_math_Init();
	app_ota_Init();
	app_connect_manage_Init();
	app_switchimu_Init();
	app_data_transfer_Init();
	app_safe_Init();
	
	#if LOSSPACK_ENANBLE 
	app_losspack_Init();
	#endif
	
	#if !BleNameHoldOn_ENANBLE
	app_pair_Init();						
	#endif
	
  app_self_checking_Init();
	
  Tool_Init();
}