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

//Add your code here...
#include "twi_master.h"
#include "hal_imu.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 "app_err.h"
#include "bsp_pwm.h"
#include "bsp_wdt.h"
#include "bsp_adc.h"
#include "tool.h"
#include "hal_imu.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 "hal_mode_manage.h"
#include "exception.h"
#include "tool.h"
#include "hal_monitor.h"

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

	if(mFlash.isHost){	//
		#if GAME_ENANBLE || 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 GAME_ENANBLE || 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)
{
	nrf_gpio_cfg_input(21,NRF_GPIO_PIN_PULLUP);//3?¦Ì?¨°y??¨¦?¨¤-
	PWR_Init();
	LED_Init();
	MT_Init();
	Flash_Initialize();
  Exception_Init();
	usr1_Init();
}

void USR_Init(void)
{
	//Add your code here...
	TIME_Init();
	#if WATCHDOG_ENANBLE
	watchdog_init();
	feed_watchdog();
	#endif

	IMU_Initialize(mFlash.isHost);
	ADC_Initialize();
	
  hal_battery_init();
	BLE_Client_Initialize();
	BLE_Host_Initialize();
	hal_wearshoes_Init();
	hal_mode_manage_Init();
	hal_monitor_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();
	
	#if LOSSPACK_ENANBLE 
	app_losspack_Init();
	#endif
	
	#if !BleNameHoldOn_ENANBLE
	app_pair_Init();						
	#endif
	app_self_checking_Init();
	
	app_err_Init();
  Tool_Init();
}