/*---------------------------------------------------------------------------------------------------------------------
---------------------------------------------------------------------------------------------------------------------*/
C_RESULT ardrone_tool_init(int argc, char **argv)
{
	C_RESULT res;

	//Fill structure AT codec and built the library AT commands.
	ardrone_at_init( wifi_ardrone_ip, strlen( wifi_ardrone_ip) );

	// Init subsystems
	ardrone_timer_reset(&ardrone_tool_timer);

	ardrone_tool_input_init();
	ardrone_control_init();
	ardrone_navdata_client_init();

	// Init custom tool
	res = ardrone_tool_init_custom(argc, argv);

   //Opens a connection to AT port.
	ardrone_at_open();


	START_THREAD(navdata_update, 0);
	START_THREAD(ardrone_control, 0);

	ardrone_tool_configure();

	// Send start up configuration
	ardrone_at_set_pmode( MiscVar[0] );
	ardrone_at_set_ui_misc( MiscVar[0], MiscVar[1], MiscVar[2], MiscVar[3] );
	
	return res;
}
C_RESULT ardrone_tool_init(int argc, char **argv)
{
    C_RESULT res;
    ardrone_at_init( wifi_ardrone_ip, strlen( wifi_ardrone_ip) );
    ardrone_timer_reset(&ardrone_tool_timer);
    ardrone_control_init();
    ardrone_navdata_client_init();
    res = ardrone_tool_init_custom(argc, argv);
    ardrone_at_open();
    START_THREAD(ardrone_control, 0);
    ardrone_tool_configure();


    ardrone_at_set_pmode( MiscVar[0] );
    ardrone_at_set_ui_misc( MiscVar[0], MiscVar[1], MiscVar[2], MiscVar[3] );

    return res;
}