EXPORT gboolean read_ve_const(void *data, XmlCmdType type)
{
extern Firmware_Details *firmware;
extern volatile gboolean offline;
extern volatile gboolean outstanding_data;
extern volatile gint last_page;
OutputData *output = NULL;
Command *command = NULL;
gint i = 0;
switch (type)
{
case MS1_VECONST:
if (!offline)
{
g_list_foreach(get_list("get_data_buttons"),set_widget_sensitive,GINT_TO_POINTER(FALSE));
if (outstanding_data)
queue_burn_ecu_flash(last_page);
for (i=0;i<firmware->total_pages;i++)
{
if (!firmware->page_params[i]->dl_by_default)
continue;
queue_ms1_page_change(i);
output = initialize_outputdata();
OBJ_SET(output->object,"page",GINT_TO_POINTER(i));
OBJ_SET(output->object,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[i]->phys_ecu_page));
OBJ_SET(output->object,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd(firmware->ve_command,output);
}
}
command = (Command *)data;
io_cmd(NULL,command->post_functions);
break;
case MS2_VECONST:
if (!offline)
{
g_list_foreach(get_list("get_data_buttons"),set_widget_sensitive,GINT_TO_POINTER(FALSE));
if ((firmware->capabilities & MS2_E) && (outstanding_data))
queue_burn_ecu_flash(last_page);
for (i=0;i<firmware->total_pages;i++)
{
if (!firmware->page_params[i]->dl_by_default)
continue;
output = initialize_outputdata();
OBJ_SET(output->object,"page",GINT_TO_POINTER(i));
OBJ_SET(output->object,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[i]->phys_ecu_page));
OBJ_SET(output->object,"canID",GINT_TO_POINTER(firmware->canID));
OBJ_SET(output->object,"offset", GINT_TO_POINTER(0));
OBJ_SET(output->object,"num_bytes", GINT_TO_POINTER(firmware->page_params[i]->length));
OBJ_SET(output->object,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd(firmware->ve_command,output);
}
}
command = (Command *)data;
io_cmd(NULL,command->post_functions);
break;
case MS2_E_COMPOSITEMON:
if (!offline)
{
if ((firmware->capabilities & MS2_E) && (outstanding_data))
queue_burn_ecu_flash(last_page);
output = initialize_outputdata();
OBJ_SET(output->object,"page",GINT_TO_POINTER(firmware->compositemon_page));
OBJ_SET(output->object,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->compositemon_page]->phys_ecu_page));
OBJ_SET(output->object,"canID",GINT_TO_POINTER(firmware->canID));
OBJ_SET(output->object,"offset", GINT_TO_POINTER(0));
OBJ_SET(output->object,"num_bytes", GINT_TO_POINTER(firmware->page_params[firmware->compositemon_page]->length));
OBJ_SET(output->object,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd(firmware->ve_command,output);
}
command = (Command *)data;
io_cmd(NULL,command->post_functions);
break;
case MS2_E_TRIGMON:
if (!offline)
{
if ((firmware->capabilities & MS2_E) && (outstanding_data))
queue_burn_ecu_flash(last_page);
output = initialize_outputdata();
OBJ_SET(output->object,"page",GINT_TO_POINTER(firmware->trigmon_page));
OBJ_SET(output->object,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->trigmon_page]->phys_ecu_page));
OBJ_SET(output->object,"canID",GINT_TO_POINTER(firmware->canID));
OBJ_SET(output->object,"offset", GINT_TO_POINTER(0));
OBJ_SET(output->object,"num_bytes", GINT_TO_POINTER(firmware->page_params[firmware->trigmon_page]->length));
OBJ_SET(output->object,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd(firmware->ve_command,output);
}
command = (Command *)data;
io_cmd(NULL,command->post_functions);
break;
case MS2_E_TOOTHMON:
if (!offline)
{
if ((firmware->capabilities & MS2_E) && (outstanding_data))
queue_burn_ecu_flash(last_page);
output = initialize_outputdata();
OBJ_SET(output->object,"page",GINT_TO_POINTER(firmware->toothmon_page));
OBJ_SET(output->object,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->toothmon_page]->phys_ecu_page));
OBJ_SET(output->object,"canID",GINT_TO_POINTER(firmware->canID));
OBJ_SET(output->object,"offset", GINT_TO_POINTER(0));
OBJ_SET(output->object,"num_bytes", GINT_TO_POINTER(firmware->page_params[firmware->toothmon_page]->length));
OBJ_SET(output->object,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd(firmware->ve_command,output);
}
command = (Command *)data;
io_cmd(NULL,command->post_functions);
break;
case MS1_E_TRIGMON:
if (!offline)
{
if (outstanding_data)
queue_burn_ecu_flash(last_page);
queue_ms1_page_change(firmware->trigmon_page);
output = initialize_outputdata();
OBJ_SET(output->object,"page",GINT_TO_POINTER(firmware->trigmon_page));
OBJ_SET(output->object,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->trigmon_page]->phys_ecu_page));
OBJ_SET(output->object,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd(firmware->ve_command,output);
command = (Command *)data;
io_cmd(NULL,command->post_functions);
}
break;
case MS1_E_TOOTHMON:
if (!offline)
{
if (outstanding_data)
queue_burn_ecu_flash(last_page);
queue_ms1_page_change(firmware->toothmon_page);
output = initialize_outputdata();
OBJ_SET(output->object,"page",GINT_TO_POINTER(firmware->toothmon_page));
OBJ_SET(output->object,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->toothmon_page]->phys_ecu_page));
OBJ_SET(output->object,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd(firmware->ve_command,output);
command = (Command *)data;
io_cmd(NULL,command->post_functions);
}
break;
default:
break;
}
return TRUE;
}
/*!
\brief restore_all_ecu_settings() reads the filename passed and if all checks
pass the file will be loaded and any values that differ from the values
currently in the ECU will be replaced.
\param filename (filename to read for ecu restoration
WARNING: This function is not yet capable of handling CAN devices, and will
always restore to can ID ZERO (which can be BAD!!), backup/restore needs to
be rewritten..
*/
G_MODULE_EXPORT void restore_all_ecu_settings(gchar *filename)
{
ConfigFile *cfgfile;
/*
GArray *pfuncs = NULL;
PostFunction *pf = NULL;
*/
gchar * section = NULL;
gchar * msgbuf = NULL;
gint canID = 0;
DataSize size = MTX_U08;
gint page = 0;
gint offset = 0;
gint tmpi = 0;
gint major = 0;
gint minor = 0;
gboolean restart = FALSE;
gchar *tmpbuf = NULL;
guint8 *data = NULL;
gchar **keys = NULL;
gint num_keys = 0;
gint dload_val = 0;
PostFunction *pf = NULL;
GArray *pfuncs = NULL;
extern gconstpointer *global_data;
Firmware_Details *firmware = NULL;
firmware = DATA_GET(global_data,"firmware");
g_return_if_fail(filename);
g_return_if_fail(firmware);
canID = firmware->canID;
cfgfile = cfg_open_file(filename);
if (!cfgfile)
{
update_logbar_f("tools_view","warning",g_strdup_printf(_(":restore_all_ecu_settings()\n\t Unable to open this file (%s)\n"),filename),FALSE,FALSE,TRUE);
return;
}
if (cfgfile)
{
get_file_api_f(cfgfile,&major,&minor);
if (major != BACKUP_MAJOR_API)
{
update_logbar_f("tools_view","warning",g_strdup_printf(_(":restore_all_ecu_settings()\n\tAPI MAJOR version mismatch: \"%i\" != \"%i\"\n can not load this file for restoration\n"),major,BACKUP_MAJOR_API),FALSE,FALSE,TRUE);
cfg_free(cfgfile);
return;
}
if (minor != BACKUP_MINOR_API)
update_logbar_f("tools_view","warning",g_strdup_printf(_(": restore_all_ecu_settings()\n\tAPI MINOR version mismatch: \"%i\" != \"%i\"\n Will try to load this file for restoration, expect issues\n"),minor,BACKUP_MINOR_API),FALSE,FALSE,TRUE);
cfg_read_string(cfgfile,"Firmware","name",&tmpbuf);
if (g_ascii_strcasecmp(g_strdelimit(tmpbuf," ,",'_'),g_strdelimit(firmware->name," ,",'_')) != 0)
{
dbg_func_f(CRITICAL,g_strdup_printf(__FILE__": restore_all_ecu_settings()\nFirmware name mismatch:\n\"%s\" != \"%s\",\ncannot load this file for restoration\n",tmpbuf,firmware->name));
update_logbar_f("tools_view","warning",g_strdup_printf(_(": restore_all_ecu_settings()\nFirmware name mismatch: \"%s\" != \"%s\"\ncan NOT load this file for restoration!\n"),tmpbuf,firmware->name),FALSE,FALSE,TRUE);
if (tmpbuf)
g_free(tmpbuf);
cfg_free(cfgfile);
return;
}
g_free(tmpbuf);
set_title_f(g_strdup(_("Restoring ECU settings from File")));
if (DATA_GET(global_data,"realtime_id"))
{
stop_tickler_f(RTV_TICKLER);
restart = TRUE;
}
for (page=0;page<firmware->total_pages;page++)
{
if (!(firmware->page_params[page]->dl_by_default))
continue;
section = g_strdup_printf("page_%i",page);
if(cfg_read_int(cfgfile,section,"num_variables",&tmpi))
if (tmpi != firmware->page_params[page]->length)
{
update_logbar_f("tools_view","warning",g_strdup_printf(_(": restore_all_ecu_settings()\n\tNumber of variables in backup \"%i\" and firmware specification \"%i\" do NOT match,\n\tcorruption SHOULD be expected\n"),tmpi,firmware->page_params[page]->length),FALSE,FALSE,TRUE);
dbg_func_f(CRITICAL,g_strdup_printf(_(": restore_all_ecu_settings()\n\tNumber of variables in backup \"%i\" and firmware specification \"%i\" do NOT match,\n\tcorruption SHOULD be expected\n"),tmpi,firmware->page_params[page]->length));
}
if (cfg_read_string(cfgfile,section,"data",&tmpbuf))
{
keys = parse_keys_f(tmpbuf,&num_keys,",");
if (num_keys != firmware->page_params[page]->length)
{
update_logbar_f("tools_view","warning",g_strdup_printf(_(": restore_all_ecu_settings()\n\tNumber of variables in this backup \"%i\" does NOT match the length of the table \"%i\", expect a crash!!!\n"),num_keys,firmware->page_params[page]->length),FALSE,FALSE,TRUE);
dbg_func_f(CRITICAL,g_strdup_printf(_(": restore_all_ecu_settings()\n\tNumber of variables in this backup \"%i\" does NOT match the length of the table \"%i\", expect a crash!!!\n"),num_keys,firmware->page_params[page]->length));
}
if (firmware->chunk_support)
{
data = g_new0(guint8, firmware->page_params[page]->length);
for (offset=0;offset<num_keys;offset++)
data[offset]=(guint8)atoi(keys[offset]);
if (DATA_GET(global_data,"offline"))
ms_store_new_block(canID,page,0,data,num_keys);
else
ms_chunk_write(canID,page,0,num_keys,data);
}
else
{
if (DATA_GET(global_data,"offline"))
{
for (offset=0;offset<num_keys;offset++)
{
dload_val = atoi(keys[offset]);
ms_set_ecu_data(canID,page,offset,size,dload_val);
}
}
else
{
for (offset=0;offset<num_keys;offset++)
{
dload_val = atoi(keys[offset]);
if (dload_val != ms_get_ecu_data_last(canID,page,offset,size))
{
/*printf("writing data for page %i, offset %i\n",page,offset);*/
ms_send_to_ecu(canID,page,offset,size,dload_val, FALSE);
}
}
queue_burn_ecu_flash(page);
}
}
g_strfreev(keys);
g_free(tmpbuf);
}
g_free(section);
}
start_restore_monitor();
cfg_free(cfgfile);
}
if (DATA_GET(global_data,"offline"))
{
pfuncs = g_array_new(FALSE,TRUE,sizeof(PostFunction *));
pf = g_new0(PostFunction,1);
pf->name = g_strdup("update_ecu_controls_pf");
get_symbol_f(pf->name,(void *)&pf->function);
pf->w_arg = FALSE;
pfuncs = g_array_append_val(pfuncs,pf);
pf = g_new0(PostFunction,1);
pf->name = g_strdup("set_store_black_pf");
get_symbol_f(pf->name,(void *)&pf->function);
pf->w_arg = FALSE;
pfuncs = g_array_append_val(pfuncs,pf);
io_cmd_f(NULL,pfuncs);
}
if (restart)
start_tickler_f(RTV_TICKLER);
}
/*!
\brief function to do the actual read calls from the ECU
\param data is a pointer to the Command structure
\param func is an enumeration for the type of function
\returns TRUE on success, FASE otherwise
*/
G_MODULE_EXPORT gboolean read_ve_const(void *data, FuncCall func)
{
gint last_page;
OutputData *output = NULL;
Command *command = NULL;
gint i = 0;
Firmware_Details *firmware = NULL;
ENTER();
firmware = (Firmware_Details *)DATA_GET(global_data,"firmware");
last_page = (GINT)DATA_GET(global_data,"last_page");
switch (func)
{
case MS1_VECONST:
if (!DATA_GET(global_data,"offline"))
{
g_list_foreach(get_list_f("get_data_buttons"),set_widget_sensitive_f,GINT_TO_POINTER(FALSE));
for (i=0;i<firmware->total_pages;i++)
if (firmware->page_params[i]->needs_burn)
queue_burn_ecu_flash(i);
for (i=0;i<firmware->total_pages;i++)
{
if (!firmware->page_params[i]->dl_by_default)
continue;
queue_ms1_page_change(i);
output = initialize_outputdata_f();
DATA_SET(output->data,"page",GINT_TO_POINTER(i));
DATA_SET(output->data,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[i]->phys_ecu_page));
DATA_SET(output->data,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd_f(firmware->read_command,output);
}
}
command = (Command *)data;
io_cmd_f(NULL,command->post_functions);
break;
case MS2_VECONST:
if (!DATA_GET(global_data,"offline"))
{
g_list_foreach(get_list_f("get_data_buttons"),set_widget_sensitive_f,GINT_TO_POINTER(FALSE));
for (i=0;i<firmware->total_pages;i++)
if (firmware->page_params[i]->needs_burn)
queue_burn_ecu_flash(i);
for (i=0;i<firmware->total_pages;i++)
{
if (!firmware->page_params[i]->dl_by_default)
continue;
output = initialize_outputdata_f();
DATA_SET(output->data,"page",GINT_TO_POINTER(i));
DATA_SET(output->data,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[i]->phys_ecu_page));
DATA_SET(output->data,"canID",GINT_TO_POINTER(firmware->canID));
DATA_SET(output->data,"offset", GINT_TO_POINTER(0));
DATA_SET(output->data,"num_bytes", GINT_TO_POINTER(firmware->page_params[i]->length));
DATA_SET(output->data,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd_f(firmware->read_command,output);
}
}
command = (Command *)data;
io_cmd_f(NULL,command->post_functions);
break;
case MS2_E_COMPOSITEMON:
if (!DATA_GET(global_data,"offline"))
{
if (firmware->capabilities & MS2_E)
{
for (i=0;i<firmware->total_pages;i++)
if (firmware->page_params[i]->needs_burn)
queue_burn_ecu_flash(i);
}
output = initialize_outputdata_f();
DATA_SET(output->data,"page",GINT_TO_POINTER(firmware->compositemon_page));
DATA_SET(output->data,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->compositemon_page]->phys_ecu_page));
DATA_SET(output->data,"canID",GINT_TO_POINTER(firmware->canID));
DATA_SET(output->data,"offset", GINT_TO_POINTER(0));
DATA_SET(output->data,"num_bytes", GINT_TO_POINTER(firmware->page_params[firmware->compositemon_page]->length));
DATA_SET(output->data,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd_f(firmware->read_command,output);
}
command = (Command *)data;
io_cmd_f(NULL,command->post_functions);
break;
case MS2_E_TRIGMON:
if (!DATA_GET(global_data,"offline"))
{
if (firmware->capabilities & MS2_E)
{
for (i=0;i<firmware->total_pages;i++)
if (firmware->page_params[i]->needs_burn)
queue_burn_ecu_flash(i);
}
output = initialize_outputdata_f();
DATA_SET(output->data,"page",GINT_TO_POINTER(firmware->trigmon_page));
DATA_SET(output->data,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->trigmon_page]->phys_ecu_page));
DATA_SET(output->data,"canID",GINT_TO_POINTER(firmware->canID));
DATA_SET(output->data,"offset", GINT_TO_POINTER(0));
DATA_SET(output->data,"num_bytes", GINT_TO_POINTER(firmware->page_params[firmware->trigmon_page]->length));
DATA_SET(output->data,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd_f(firmware->read_command,output);
}
command = (Command *)data;
io_cmd_f(NULL,command->post_functions);
break;
case MS2_E_TOOTHMON:
if (!DATA_GET(global_data,"offline"))
{
if (firmware->capabilities & MS2_E)
{
for (i=0;i<firmware->total_pages;i++)
if (firmware->page_params[i]->needs_burn)
queue_burn_ecu_flash(i);
}
output = initialize_outputdata_f();
DATA_SET(output->data,"page",GINT_TO_POINTER(firmware->toothmon_page));
DATA_SET(output->data,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->toothmon_page]->phys_ecu_page));
DATA_SET(output->data,"canID",GINT_TO_POINTER(firmware->canID));
DATA_SET(output->data,"offset", GINT_TO_POINTER(0));
DATA_SET(output->data,"num_bytes", GINT_TO_POINTER(firmware->page_params[firmware->toothmon_page]->length));
DATA_SET(output->data,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd_f(firmware->read_command,output);
}
command = (Command *)data;
io_cmd_f(NULL,command->post_functions);
break;
case MS1_E_TRIGMON:
if (!DATA_GET(global_data,"offline"))
{
for (i=0;i<firmware->total_pages;i++)
if (firmware->page_params[i]->needs_burn)
queue_burn_ecu_flash(i);
queue_ms1_page_change(firmware->trigmon_page);
output = initialize_outputdata_f();
DATA_SET(output->data,"page",GINT_TO_POINTER(firmware->trigmon_page));
DATA_SET(output->data,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->trigmon_page]->phys_ecu_page));
DATA_SET(output->data,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd_f(firmware->read_command,output);
command = (Command *)data;
io_cmd_f(NULL,command->post_functions);
}
break;
case MS1_E_TOOTHMON:
if (!DATA_GET(global_data,"offline"))
{
for (i=0;i<firmware->total_pages;i++)
if (firmware->page_params[i]->needs_burn)
queue_burn_ecu_flash(i);
queue_ms1_page_change(firmware->toothmon_page);
output = initialize_outputdata_f();
DATA_SET(output->data,"page",GINT_TO_POINTER(firmware->toothmon_page));
DATA_SET(output->data,"phys_ecu_page",GINT_TO_POINTER(firmware->page_params[firmware->toothmon_page]->phys_ecu_page));
DATA_SET(output->data,"mode", GINT_TO_POINTER(MTX_CMD_WRITE));
io_cmd_f(firmware->read_command,output);
command = (Command *)data;
io_cmd_f(NULL,command->post_functions);
}
break;
default:
break;
}
EXIT();
return TRUE;
}
