double search_k(t_scene *scene, t_cam *cam, t_point *point, t_object **tmp)
{
double k;
double real_k;
k = 0.0;
real_k = 0.0;
(*tmp) = NULL;
while (scene && scene->obj && scene->obj != NULL)
{
k = calc_k(scene->obj, point, cam);
if (k < real_k && real_k >= 0.0 && k >= 0.0)
{
real_k = k;
(*tmp) = scene->obj;
}
else if (real_k == 0.0 && k >= 0.0)
{
real_k = k;
(*tmp) = scene->obj;
}
scene->obj = scene->obj->next;
}
scene->obj = (*tmp);
while (scene->obj && scene->obj->prev)
scene->obj = scene->obj->prev;
return (real_k);
}
void inter_paraboloide(t_scene *sc)
{
t_dis dis;
double k;
t_info save;
rotate(sc);
translat(sc);
dis.a = (sc->tmp_vec->x * sc->tmp_vec->x)
+ (sc->tmp_vec->y * sc->tmp_vec->y)
- (sc->obj->cte * sc->tmp_vec->z);
dis.b = 2.f * ((sc->tmp_oeil->x * sc->tmp_vec->x) +
(sc->tmp_oeil->y * sc->tmp_vec->y) +
(- sc->obj->cte * sc->tmp_oeil->z));
dis.c = (sc->tmp_oeil->x * sc->tmp_oeil->x)
+ (sc->tmp_oeil->y * sc->tmp_oeil->y)
- (sc->obj->cte * sc->tmp_oeil->z);
dis.dis = dis.b * dis.b - 4.f * dis.a * dis.c;
k = calc_k(dis.a, dis.b, dis.dis);
if (k <= 0)
return ;
if (k < sc->info->k || sc->info->k == -42)
{
save_info(sc->info, &save);
sc->info->k = k;
sc->info->x = sc->tmp_oeil->x + k * sc->tmp_vec->x;
sc->info->y = sc->tmp_oeil->y + k * sc->tmp_vec->y;
sc->info->z = sc->tmp_oeil->z + k * sc->tmp_vec->z;
limit_object(sc);
if (sc->info->k == -42)
save_info(&save, sc->info);
sc->info->obj = sc->obj;
}
}
int
inter_sphere(t_camera *camera, t_object *object, t_detail *detail, double *vector)
{
double indice[NB_INDICE];
double k[2];
if (!camera || !object || !detail || !vector ||
inter_indice_sphere(camera, object, vector, indice))
return (EXIT_FAILURE);
if (indice[DELTA] >= 0.0F)
{
if (calc_k(indice, k))
return (EXIT_FAILURE);
if (object->inhibitor)
obj_inhibitor(k, object, camera, vector);
if ((detail->k < CONST_ERROR && (k[0] > CONST_ERROR || k[1] > CONST_ERROR)) ||
(k[0] > CONST_ERROR && (k[1] > CONST_ERROR && k[0] < k[1]) && k[0] < detail->k) ||
(k[1] > CONST_ERROR && (k[0] > CONST_ERROR && k[1] < k[0]) && k[1] < detail->k))
{
detail->k = SMALLER_POSITIVE_NUMBER(k[0], k[1]);
detail->object = object;
}
}
return (EXIT_SUCCESS);
}
double *mlpg(PStream * pst)
{
int doupdate(PStream *, int);
void calc_pi(PStream *, int);
void calc_k(PStream *, int);
void update_P(PStream *, int);
void update_c(PStream *, int);
int tcur, tmin, tmax;
int d, m, u;
pst->sm.t++;
tcur = pst->sm.t & pst->sm.mask;
tmin = (pst->sm.t - pst->range) & pst->sm.mask;
tmax = (pst->sm.t + pst->dw.maxw[WRIGHT]) & pst->sm.mask;
for (u = -pst->range * 2; u <= pst->range * 2; u++) {
for (m = 0; m <= pst->order; m++)
pst->sm.P[u][tmax][m] = 0.0;
}
for (m = 0; m < pst->vSize; m++) {
pst->sm.mseq[tmax][m] = pst->mean[m];
pst->sm.ivseq[tmax][m] = pst->ivar[m];
}
for (m = 0; m <= pst->order; m++) {
if (pst->iType != 2)
pst->sm.c[tmax][m] = pst->mean[m];
else
pst->sm.c[tmax][m] = pst->mean[m] * finv(pst->ivar[m]);
pst->sm.P[0][tmax][m] = finv(pst->ivar[m]);
}
for (d = 1; d < pst->dw.num; d++) {
if (doupdate(pst, d)) {
calc_pi(pst, d);
calc_k(pst, d);
update_P(pst, d);
update_c(pst, d);
}
}
pst->par = pst->sm.c[tmin];
return (pst->par);
}
void inter_cone(t_scene *sc)
{
t_dis dis;
double k;
t_info save;
rotate(sc);
translat(sc);
dis.a = (sc->tmp_vec->x * sc->tmp_vec->x) +
(sc->tmp_vec->y * sc->tmp_vec->y) -
(sc->obj->cte * (sc->tmp_vec->z * sc->tmp_vec->z));
dis.b = 2.f * ((sc->tmp_oeil->x * sc->tmp_vec->x) +
(sc->tmp_oeil->y * sc->tmp_vec->y) +
(- sc->obj->cte * (sc->tmp_oeil->z * sc->tmp_vec->z)));
dis.c = (sc->tmp_oeil->x * sc->tmp_oeil->x) +
(sc->tmp_oeil->y * sc->tmp_oeil->y) -
(sc->obj->cte * (sc->tmp_oeil->z * sc->tmp_oeil->z));
dis.dis = dis.b * dis.b - 4.f * dis.a * dis.c;
k = calc_k(dis.a, dis.b, dis.dis);
if (sc->obj->neg)
{
statics_k(1, (-dis.b + sqrt(dis.dis)) / (2.f * dis.a),
(-dis.b - sqrt(dis.dis)) / (2.f * dis.a));
return ;
}
if (statics_k(0, k, 0) || !k)
return;
if ((k < sc->info->k || sc->info->k == -42) && k)
{
save_info(&save, sc->info);
sc->info->k = k;
sc->info->x = sc->tmp_oeil->x + k * sc->tmp_vec->x;
sc->info->y = sc->tmp_oeil->y + k * sc->tmp_vec->y;
sc->info->z = sc->tmp_oeil->z + k * sc->tmp_vec->z;
limit_object(sc);
if (sc->info->k == -42)
save_info(sc->info, &save);
sc->info->obj = sc->obj;
}
}
void obj_inhibitor(double *k, t_object *obj, t_camera *camera,
double *vector)
{
double indice_inib[NB_INDICE];
double k_inib[2];
t_object *tmp;
ptr_f_inhib inter_indice[6];
int flag;
flag = 0;
k_in_order(k);
create_ptr_func_inhib(inter_indice);
while (!flag)
{
flag = 1;
tmp = obj->inhibitor;
while (tmp)
{
inter_indice[tmp->type](camera, tmp, vector, indice_inib);
if (indice_inib[DELTA] >= 0.0F)
{
calc_k(indice_inib, k_inib);
k_in_order(k_inib);
if (k_inib[0] >= 0.000 && k_inib[1] >= 0.000
&& k_inib[0] < k[0] && k_inib[1] > k[0] && k_inib[1] < k[1])
{
k[0] = k_inib[1];
flag = 0;
}
if (((k_inib[0] >= 0.000 && k_inib[1] >= 0.000) && k_inib[0] <= k[0]
&& k_inib[1] > k[0] && k_inib[1] > k[1])
|| (k_inib[0] && !k_inib[1]))
k[0] = -1.000;
}
tmp = tmp->next;
}
}
k[1] = -1.0;
}
myResult* simulate_implicit(Model_t *m, myResult *result, mySpecies *sp[], myParameter *param[], myCompartment *comp[], myReaction *re[], myRule *rule[], myEvent *event[], myInitialAssignment *initAssign[], myAlgebraicEquations *algEq, timeVariantAssignments *timeVarAssign, double sim_time, double dt, int print_interval, double *time, int order, int use_lazy_method, int print_amount, allocated_memory *mem){
unsigned int i, j;
int cycle;
int error;
int end_cycle = get_end_cycle(sim_time, dt);
double reverse_time;
double *value_time_p = result->values_time;
double *value_sp_p = result->values_sp;
double *value_param_p = result->values_param;
double *value_comp_p = result->values_comp;
double **coefficient_matrix = NULL;
double *constant_vector = NULL;
int *alg_pivot = NULL;
double reactants_numerator, products_numerator;
double min_value;
double *init_val;
/* for implicit */
double **jacobian;
int is_convergence = 0;
double *b;
double *pre_b;
int *p; /* for pivot selection */
boolean flag;
double delta = 1.0e-8;
double tolerance = 1.0e-4; /* error tolerance of neuton method */
unsigned int loop;
double *delta_value;
double k_next; /* speculated k value : k(t+1) */
double *k_t; /* k(t) */
/* num of SBase objects */
unsigned int num_of_species = Model_getNumSpecies(m);
unsigned int num_of_parameters = Model_getNumParameters(m);
unsigned int num_of_compartments = Model_getNumCompartments(m);
unsigned int num_of_reactions = Model_getNumReactions(m);
unsigned int num_of_rules = Model_getNumRules(m);
unsigned int num_of_events = Model_getNumEvents(m);
unsigned int num_of_initialAssignments = Model_getNumInitialAssignments(m);
/* num of variables whose quantity is not a constant */
unsigned int num_of_all_var_species = 0;
unsigned int num_of_all_var_parameters = 0;
unsigned int num_of_all_var_compartments = 0;
unsigned int num_of_all_var_species_reference = 0;
/* num of variables (which is NOT changed by assignment nor algebraic rule) */
unsigned int num_of_var_species = 0;
unsigned int num_of_var_parameters = 0;
unsigned int num_of_var_compartments = 0;
unsigned int num_of_var_species_reference = 0;
unsigned int sum_num_of_vars;
/* All variables (whose quantity is not a constant) */
mySpecies **all_var_sp; /* all variable species */
myParameter **all_var_param; /* all variable parameters */
myCompartment **all_var_comp; /* all variable compartments */
mySpeciesReference **all_var_spr; /* all varialbe SpeciesReferences */
/* variables (which is NOT changed by assignment nor algebraic rule) */
mySpecies **var_sp;
myParameter **var_param;
myCompartment **var_comp;
mySpeciesReference **var_spr;
set_seed();
check_num(num_of_species, num_of_parameters, num_of_compartments, num_of_reactions, &num_of_all_var_species, &num_of_all_var_parameters, &num_of_all_var_compartments, &num_of_all_var_species_reference, &num_of_var_species, &num_of_var_parameters, &num_of_var_compartments, &num_of_var_species_reference, sp, param, comp, re);
/* create objects */
all_var_sp = (mySpecies **)malloc(sizeof(mySpecies *) * num_of_all_var_species);
all_var_param = (myParameter **)malloc(sizeof(myParameter *) * num_of_all_var_parameters);
all_var_comp = (myCompartment **)malloc(sizeof(myCompartment *) * num_of_all_var_compartments);
all_var_spr = (mySpeciesReference **)malloc(sizeof(mySpeciesReference *) * num_of_all_var_species_reference);
var_sp = (mySpecies **)malloc(sizeof(mySpecies *) * num_of_var_species);
var_param = (myParameter **)malloc(sizeof(myParameter *) * num_of_var_parameters);
var_comp = (myCompartment **)malloc(sizeof(myCompartment *) * num_of_var_compartments);
var_spr = (mySpeciesReference **)malloc(sizeof(mySpeciesReference *) * num_of_var_species_reference);
/* mySpecies *all_var_sp[num_of_all_var_species]; */
/* myParameter *all_var_param[num_of_all_var_parameters]; */
/* myCompartment *all_var_comp[num_of_all_var_compartments]; */
/* mySpeciesReference *all_var_spr[num_of_all_var_species_reference]; */
/* mySpecies *var_sp[num_of_var_species]; */
/* myParameter *var_param[num_of_var_parameters]; */
/* myCompartment *var_comp[num_of_var_compartments]; */
/* mySpeciesReference *var_spr[num_of_var_species_reference]; */
create_calc_object_list(num_of_species, num_of_parameters, num_of_compartments, num_of_reactions, all_var_sp, all_var_param, all_var_comp, all_var_spr, var_sp, var_param, var_comp, var_spr, sp, param, comp, re);
sum_num_of_vars = num_of_var_species + num_of_var_parameters +
num_of_var_compartments + num_of_var_species_reference;
jacobian = (double**)malloc(sizeof(double*)*(sum_num_of_vars));
for(i=0; i<sum_num_of_vars; i++){
jacobian[i] = (double*)malloc(sizeof(double)*(sum_num_of_vars));
}
b = (double *)malloc(sizeof(double) * (sum_num_of_vars));
pre_b = (double *)malloc(sizeof(double) * (sum_num_of_vars));
p = (int *)malloc(sizeof(int) * (sum_num_of_vars));
delta_value = (double *)malloc(sizeof(double) * (sum_num_of_vars));
k_t = (double *)malloc(sizeof(double) * (sum_num_of_vars));
/*
double b[sum_num_of_vars];
double pre_b[sum_num_of_vars];
int p[sum_num_of_vars];
double delta_value[sum_num_of_vars];
double k_t[sum_num_of_vars];
*/
if(algEq != NULL){
coefficient_matrix = (double**)malloc(sizeof(double*)*(algEq->num_of_algebraic_variables));
for(i=0; i<algEq->num_of_algebraic_variables; i++){
coefficient_matrix[i] = (double*)malloc(sizeof(double)*(algEq->num_of_algebraic_variables));
}
constant_vector = (double*)malloc(sizeof(double)*(algEq->num_of_algebraic_variables));
alg_pivot = (int*)malloc(sizeof(int)*(algEq->num_of_algebraic_variables));
}
PRG_TRACE(("Simulation for [%s] Starts!\n", Model_getId(m)));
cycle = 0;
/* initialize delay_val */
initialize_delay_val(sp, num_of_species, param, num_of_parameters, comp, num_of_compartments, re, num_of_reactions, sim_time, dt, 0);
/* calc temp value by assignment */
for(i=0; i<num_of_all_var_species; i++){
if(all_var_sp[i]->depending_rule != NULL && all_var_sp[i]->depending_rule->is_assignment){
all_var_sp[i]->temp_value = calc(all_var_sp[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_parameters; i++){
if(all_var_param[i]->depending_rule != NULL && all_var_param[i]->depending_rule->is_assignment){
all_var_param[i]->temp_value = calc(all_var_param[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_compartments; i++){
if(all_var_comp[i]->depending_rule != NULL && all_var_comp[i]->depending_rule->is_assignment){
all_var_comp[i]->temp_value = calc(all_var_comp[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_species_reference; i++){
if(all_var_spr[i]->depending_rule != NULL && all_var_spr[i]->depending_rule->is_assignment){
all_var_spr[i]->temp_value = calc(all_var_spr[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
/* forwarding value */
forwarding_value(all_var_sp, num_of_all_var_species, all_var_param, num_of_all_var_parameters, all_var_comp, num_of_all_var_compartments, all_var_spr, num_of_all_var_species_reference);
/* initialize delay_val */
initialize_delay_val(sp, num_of_species, param, num_of_parameters, comp, num_of_compartments, re, num_of_reactions, sim_time, dt, 0);
/* calc InitialAssignment */
calc_initial_assignment(initAssign, num_of_initialAssignments, dt, cycle, &reverse_time);
/* initialize delay_val */
initialize_delay_val(sp, num_of_species, param, num_of_parameters, comp, num_of_compartments, re, num_of_reactions, sim_time, dt, 0);
/* rewriting for explicit delay */
for(i=0; i<num_of_initialAssignments; i++){
for(j=0; j<initAssign[i]->eq->math_length; j++){
if(initAssign[i]->eq->number[j] == time){
TRACE(("time is replaced with reverse time\n"));
initAssign[i]->eq->number[j] = &reverse_time;
}else if(initAssign[i]->eq->number[j] != NULL){
init_val = (double*)malloc(sizeof(double));
*init_val = *initAssign[i]->eq->number[j];
mem->memory[mem->num_of_allocated_memory++] = init_val;
initAssign[i]->eq->number[j] = init_val;
}
}
}
for(i=0; i<timeVarAssign->num_of_time_variant_assignments; i++){
for(j=0; j<timeVarAssign->eq[i]->math_length; j++){
if(timeVarAssign->eq[i]->number[j] == time){
TRACE(("time is replaced with reverse time\n"));
timeVarAssign->eq[i]->number[j] = &reverse_time;
}else if(timeVarAssign->eq[i]->number[j] != NULL){
init_val = (double*)malloc(sizeof(double));
*init_val = *timeVarAssign->eq[i]->number[j];
mem->memory[mem->num_of_allocated_memory++] = init_val;
timeVarAssign->eq[i]->number[j] = init_val;
}
}
}
/* initialize delay_val */
initialize_delay_val(sp, num_of_species, param, num_of_parameters, comp, num_of_compartments, re, num_of_reactions, sim_time, dt, 0);
/* calc temp value by assignment */
for(i=0; i<num_of_all_var_species; i++){
if(all_var_sp[i]->depending_rule != NULL && all_var_sp[i]->depending_rule->is_assignment){
all_var_sp[i]->temp_value = calc(all_var_sp[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_parameters; i++){
if(all_var_param[i]->depending_rule != NULL && all_var_param[i]->depending_rule->is_assignment){
all_var_param[i]->temp_value = calc(all_var_param[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_compartments; i++){
if(all_var_comp[i]->depending_rule != NULL && all_var_comp[i]->depending_rule->is_assignment){
all_var_comp[i]->temp_value = calc(all_var_comp[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_species_reference; i++){
if(all_var_spr[i]->depending_rule != NULL && all_var_spr[i]->depending_rule->is_assignment){
all_var_spr[i]->temp_value = calc(all_var_spr[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
/* forwarding value */
forwarding_value(all_var_sp, num_of_all_var_species, all_var_param, num_of_all_var_parameters, all_var_comp, num_of_all_var_compartments, all_var_spr, num_of_all_var_species_reference);
/* initialize delay_val */
initialize_delay_val(sp, num_of_species, param, num_of_parameters, comp, num_of_compartments, re, num_of_reactions, sim_time, dt, 0);
/* calc temp value algebraic by algebraic */
if(algEq != NULL){
if(algEq->num_of_algebraic_variables > 1){
/* initialize pivot */
for(i=0; i<algEq->num_of_algebraic_variables; i++){
alg_pivot[i] = i;
}
for(i=0; i<algEq->num_of_algebraic_variables; i++){
for(j=0; j<algEq->num_of_algebraic_variables; j++){
coefficient_matrix[i][j] = calc(algEq->coefficient_matrix[i][j], dt, cycle, &reverse_time, 0);
/* TRACE(("coefficient matrix[%d][%d] = %lf\n", i, j, coefficient_matrix[i][j])); */
}
}
for(i=0; i<algEq->num_of_algebraic_variables; i++){
constant_vector[i] = -calc(algEq->constant_vector[i], dt, cycle, &reverse_time, 0);
/* TRACE(("constant vector[%d] = %lf\n", i, constant_vector[i])); */
}
/* LU decompostion */
error = lu_decomposition(coefficient_matrix, alg_pivot, algEq->num_of_algebraic_variables);
if(error == 0){/* failure in LU decomposition */
return NULL;
}
/* forward substitution & backward substitution */
lu_solve(coefficient_matrix, alg_pivot, algEq->num_of_algebraic_variables, constant_vector);
/* for(i=0; i<algEq->num_of_algebraic_variables; i++){ */
/* TRACE(("ans[%d] = %lf\n", i, constant_vector[i])); */
/* } */
for(i=0; i<algEq->num_of_alg_target_sp; i++){
algEq->alg_target_species[i]->target_species->temp_value = constant_vector[algEq->alg_target_species[i]->order];
}
for(i=0; i<algEq->num_of_alg_target_param; i++){
algEq->alg_target_parameter[i]->target_parameter->temp_value = constant_vector[algEq->alg_target_parameter[i]->order];
}
for(i=0; i<algEq->num_of_alg_target_comp; i++){
/* new code */
for(j=0; j<algEq->alg_target_compartment[i]->target_compartment->num_of_including_species; j++){
if(algEq->alg_target_compartment[i]->target_compartment->including_species[j]->is_concentration){
algEq->alg_target_compartment[i]->target_compartment->including_species[j]->temp_value = algEq->alg_target_compartment[i]->target_compartment->including_species[j]->temp_value*algEq->alg_target_compartment[i]->target_compartment->temp_value/constant_vector[algEq->alg_target_compartment[i]->order];
}
}
/* new code end */
algEq->alg_target_compartment[i]->target_compartment->temp_value = constant_vector[algEq->alg_target_compartment[i]->order];
}
}else{
if(algEq->target_species != NULL){
algEq->target_species->temp_value = -calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0);
}
if(algEq->target_parameter != NULL){
algEq->target_parameter->temp_value = -calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0);
}
if(algEq->target_compartment != NULL){
/* new code */
for(i=0; i<algEq->target_compartment->num_of_including_species; i++){
if(algEq->target_compartment->including_species[i]->is_concentration){
algEq->target_compartment->including_species[i]->temp_value = algEq->target_compartment->including_species[i]->temp_value*algEq->target_compartment->temp_value/(-calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0));
}
}
/* new code end */
algEq->target_compartment->temp_value = -calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0);
}
}
/* forwarding value */
forwarding_value(all_var_sp, num_of_all_var_species, all_var_param, num_of_all_var_parameters, all_var_comp, num_of_all_var_compartments, all_var_spr, num_of_all_var_species_reference);
}
/* initialize delay_val */
initialize_delay_val(sp, num_of_species, param, num_of_parameters, comp, num_of_compartments, re, num_of_reactions, sim_time, dt, 1);
/* cycle start */
for(cycle=0; cycle<=end_cycle; cycle++){
/* calculate unreversible fast reaction */
for(i=0; i<num_of_reactions; i++){
if(re[i]->is_fast && !re[i]->is_reversible){
if(calc(re[i]->eq, dt, cycle, &reverse_time, 0) > 0){
min_value = DBL_MAX;
for(j=0; j<re[i]->num_of_reactants; j++){
if(min_value > re[i]->reactants[j]->mySp->value/calc(re[i]->reactants[j]->eq, dt, cycle, &reverse_time, 0)){
min_value = re[i]->reactants[j]->mySp->value/calc(re[i]->reactants[j]->eq, dt, cycle, &reverse_time, 0);
}
}
for(j=0; j<re[i]->num_of_products; j++){
if(!Species_getBoundaryCondition(re[i]->products[j]->mySp->origin)){
re[i]->products[j]->mySp->value += calc(re[i]->products[j]->eq, dt, cycle, &reverse_time, 0)*min_value;
re[i]->products[j]->mySp->temp_value = re[i]->products[j]->mySp->value;
}
}
for(j=0; j<re[i]->num_of_reactants; j++){
if(!Species_getBoundaryCondition(re[i]->reactants[j]->mySp->origin)){
re[i]->reactants[j]->mySp->value -= calc(re[i]->reactants[j]->eq, dt, cycle, &reverse_time, 0)*min_value;
re[i]->reactants[j]->mySp->temp_value = re[i]->reactants[j]->mySp->value;
}
}
}
}
}
/* calculate reversible fast reactioin */
for(i=0; i<num_of_reactions; i++){
if(re[i]->is_fast && re[i]->is_reversible){
if(!(Species_getBoundaryCondition(re[i]->products[0]->mySp->origin)
&& Species_getBoundaryCondition(re[i]->reactants[0]->mySp->origin))){
products_numerator = calc(re[i]->products_equili_numerator, dt, cycle, &reverse_time, 0);
reactants_numerator = calc(re[i]->reactants_equili_numerator, dt, cycle, &reverse_time, 0);
if(products_numerator > 0 || reactants_numerator > 0){
if(Species_getBoundaryCondition(re[i]->products[0]->mySp->origin)){
re[i]->reactants[0]->mySp->value = (reactants_numerator/products_numerator)*re[i]->products[0]->mySp->value;
re[i]->reactants[0]->mySp->temp_value = re[i]->reactants[0]->mySp->value;
}else if(Species_getBoundaryCondition(re[i]->reactants[0]->mySp->origin)){
re[i]->products[0]->mySp->value = (products_numerator/reactants_numerator)*re[i]->reactants[0]->mySp->value;
re[i]->products[0]->mySp->temp_value = re[i]->products[0]->mySp->value;
}else{
re[i]->products[0]->mySp->value = (products_numerator/(products_numerator+reactants_numerator))*(re[i]->products[0]->mySp->temp_value+re[i]->reactants[0]->mySp->temp_value);
re[i]->reactants[0]->mySp->value = (reactants_numerator/(products_numerator+reactants_numerator))*(re[i]->products[0]->mySp->temp_value+re[i]->reactants[0]->mySp->temp_value);
re[i]->products[0]->mySp->temp_value = re[i]->products[0]->mySp->value;
re[i]->reactants[0]->mySp->temp_value = re[i]->reactants[0]->mySp->value;
}
}
}
}
}
/* event */
calc_event(event, num_of_events, dt, *time, cycle, &reverse_time);
/* substitute delay val */
substitute_delay_val(sp, num_of_species, param, num_of_parameters, comp, num_of_compartments, re, num_of_reactions, cycle);
/* progress */
if(cycle%(int)(end_cycle/10) == 0){
PRG_TRACE(("%3d %%\n", (int)(100*((double)cycle/(double)end_cycle))));
PRG_TRACE(("\x1b[1A"));
PRG_TRACE(("\x1b[5D"));
}
/* print result */
if(cycle%print_interval == 0){
/* Time */
*value_time_p = *time;
value_time_p++;
/* Species */
for(i=0; i<num_of_species; i++){
/* if(!(Species_getConstant(sp[i]->origin) && Species_getBoundaryCondition(sp[i]->origin))){ // XXX must remove this */
if(print_amount){
if(sp[i]->is_concentration){
*value_sp_p = sp[i]->value*sp[i]->locating_compartment->value;
}else{
*value_sp_p = sp[i]->value;
}
}else{
if(sp[i]->is_amount){
*value_sp_p = sp[i]->value/sp[i]->locating_compartment->value;
}else{
*value_sp_p = sp[i]->value;
}
}
value_sp_p++;
/* } */
}
/* Parameter */
for(i=0; i<num_of_parameters; i++){
/* if(!Parameter_getConstant(param[i]->origin)){ // XXX must remove this */
*value_param_p = param[i]->value;
/* } */
value_param_p++;
}
/* Compartment */
for(i=0; i<num_of_compartments; i++){
/* if(!Compartment_getConstant(comp[i]->origin)){ // XXX must remove this */
*value_comp_p = comp[i]->value;
/* } */
value_comp_p++;
}
}
/* time increase */
*time = (cycle+1)*dt;
/* implicit method */
/* define init value by Euler start */
calc_k(all_var_sp, num_of_all_var_species, all_var_param, num_of_all_var_parameters, all_var_comp, num_of_all_var_compartments, all_var_spr, num_of_all_var_species_reference, re, num_of_reactions, rule, num_of_rules, cycle, dt, &reverse_time, 0, 1);
/* preserve k(t) value */
for(i=0; i<sum_num_of_vars; i++){
if(i < num_of_var_species){
k_t[i] = var_sp[i]->k[0];
}else if(i < num_of_var_species+num_of_var_parameters){
k_t[i] = var_param[i-num_of_var_species]->k[0];
}else if(i < num_of_var_species+num_of_var_parameters+num_of_var_compartments){
k_t[i] = var_comp[i-num_of_var_species-num_of_var_parameters]->k[0];
}else{
k_t[i] = var_spr[i-num_of_var_species-num_of_var_parameters-num_of_var_compartments]->k[0];
}
}
calc_temp_value(all_var_sp, num_of_all_var_species, all_var_param, num_of_all_var_parameters, all_var_comp, num_of_all_var_compartments, all_var_spr, num_of_all_var_species_reference, dt, 0);
/* define init value by Euler end */
/* newton method */
if(use_lazy_method){
is_convergence = 0;
for(i=0; i<sum_num_of_vars; i++){
pre_b[i] = 0;
}
}
flag = 1;
while(flag){
/* calc b */
calc_k(var_sp, num_of_var_species, var_param, num_of_var_parameters, var_comp, num_of_var_compartments, var_spr, num_of_var_species_reference, re, num_of_reactions, rule, num_of_rules, cycle, dt, &reverse_time, 0, 0);
for(i=0; i<num_of_var_species; i++){
k_next = var_sp[i]->k[0];
b[i] = calc_implicit_formula(order, var_sp[i]->temp_value, var_sp[i]->value, var_sp[i]->prev_val[0], var_sp[i]->prev_val[1], var_sp[i]->prev_val[2], k_next, k_t[i], var_sp[i]->prev_k[0], var_sp[i]->prev_k[1], dt);
}
for(i=0; i<num_of_var_parameters; i++){
b[num_of_var_species+i] = calc_implicit_formula(order, var_param[i]->temp_value, var_param[i]->value, var_param[i]->prev_val[0], var_param[i]->prev_val[1], var_param[i]->prev_val[2], var_param[i]->k[0], k_t[num_of_var_species+i], var_param[i]->prev_k[0], var_param[i]->prev_k[1], dt);
}
for(i=0; i<num_of_var_compartments; i++){
b[num_of_var_species+num_of_var_parameters+i] = calc_implicit_formula(order, var_comp[i]->temp_value, var_comp[i]->value, var_comp[i]->prev_val[0], var_comp[i]->prev_val[1], var_comp[i]->prev_val[2], var_comp[i]->k[0], k_t[num_of_var_species+num_of_var_parameters+i], var_comp[i]->prev_k[0], var_comp[i]->prev_k[1], dt);
}
for(i=0; i<num_of_var_species_reference; i++){
b[num_of_var_species+num_of_var_parameters+num_of_var_compartments+i] = calc_implicit_formula(order, var_spr[i]->temp_value, var_spr[i]->value, var_spr[i]->prev_val[0], var_spr[i]->prev_val[1], var_spr[i]->prev_val[2], var_spr[i]->k[0], k_t[num_of_var_species+num_of_var_parameters+num_of_var_compartments+i], var_spr[i]->prev_k[0], var_spr[i]->prev_k[1], dt);
}
if(!use_lazy_method || !is_convergence){
/* calc jacobian by numerical differentiation */
for(loop=0; loop<sum_num_of_vars; loop++){
if(loop < num_of_var_species){
var_sp[loop]->temp_value += delta;
}else if(loop < num_of_var_species+num_of_var_parameters){
var_param[loop-num_of_var_species]->temp_value += delta;
}else if(loop < num_of_var_species+num_of_var_parameters+num_of_var_compartments){
var_comp[loop-num_of_var_species-num_of_var_parameters]->temp_value += delta;
}else{
var_spr[loop-num_of_var_species-num_of_var_parameters-num_of_var_compartments]->temp_value += delta;
}
calc_k(var_sp, num_of_var_species, var_param, num_of_var_parameters, var_comp, num_of_var_compartments, var_spr, num_of_var_species_reference, re, num_of_reactions, rule, num_of_rules, cycle, dt, &reverse_time, 0, 0);
for(i=0; i<num_of_var_species; i++){
k_next = var_sp[i]->k[0];
delta_value[i] = calc_implicit_formula(order, var_sp[i]->temp_value, var_sp[i]->value, var_sp[i]->prev_val[0], var_sp[i]->prev_val[1], var_sp[i]->prev_val[2], k_next, k_t[i], var_sp[i]->prev_k[0], var_sp[i]->prev_k[1], dt);
/* numerical differentiation */
jacobian[i][loop] = (delta_value[i]-b[i])/delta;
}
for(i=0; i<num_of_var_parameters; i++){
delta_value[num_of_var_species+i] = calc_implicit_formula(order, var_param[i]->temp_value, var_param[i]->value, var_param[i]->prev_val[0], var_param[i]->prev_val[1], var_param[i]->prev_val[2], var_param[i]->k[0], k_t[num_of_var_species+i], var_param[i]->prev_k[0], var_param[i]->prev_k[1], dt);
/* numerical differentiation */
jacobian[num_of_var_species+i][loop] = (delta_value[num_of_var_species+i]-b[num_of_var_species+i])/delta;
}
for(i=0; i<num_of_var_compartments; i++){
delta_value[num_of_var_species+num_of_var_parameters+i] = calc_implicit_formula(order, var_comp[i]->temp_value, var_comp[i]->value, var_comp[i]->prev_val[0], var_comp[i]->prev_val[1], var_comp[i]->prev_val[2], var_comp[i]->k[0], k_t[num_of_var_species+num_of_var_parameters+i], var_comp[i]->prev_k[0], var_comp[i]->prev_k[1], dt);
/* numerical differentiation */
jacobian[num_of_var_species+num_of_var_parameters+i][loop] = (delta_value[num_of_var_species+num_of_var_parameters+i]-b[num_of_var_species+num_of_var_parameters+i])/delta;
}
for(i=0; i<num_of_var_species_reference; i++){
delta_value[num_of_var_species+num_of_var_parameters+num_of_var_compartments+i] = calc_implicit_formula(order, var_spr[i]->temp_value, var_spr[i]->value, var_spr[i]->prev_val[0], var_spr[i]->prev_val[1], var_spr[i]->prev_val[2], var_spr[i]->k[0], k_t[num_of_var_species+num_of_var_parameters+num_of_var_compartments+i], var_spr[i]->prev_k[0], var_spr[i]->prev_k[1], dt);
/* numerical differentiation */
jacobian[num_of_var_species+num_of_var_parameters+num_of_var_compartments+i][loop] = (delta_value[num_of_var_species+num_of_var_parameters+num_of_var_compartments+i]-b[num_of_var_species+num_of_var_parameters+num_of_var_compartments+i])/delta;
}
if(loop < num_of_var_species){
var_sp[loop]->temp_value -= delta;
}else if(loop < num_of_var_species+num_of_var_parameters){
var_param[loop-num_of_var_species]->temp_value -= delta;
}else if(loop < num_of_var_species+num_of_var_parameters+num_of_var_compartments){
var_comp[loop-num_of_var_species-num_of_var_parameters]->temp_value -= delta;
}else{
var_spr[loop-num_of_var_species-num_of_var_parameters-num_of_var_compartments]->temp_value -= delta;
}
}
}
/* initialize p */
for(i=0; i<sum_num_of_vars; i++){
p[i] = i;
}
/* LU decomposition */
error = lu_decomposition(jacobian, p, sum_num_of_vars);
if(error == 0){/* failure in LU decomposition */
return NULL;
}
/* forward substitution & backward substitution */
lu_solve(jacobian, p, sum_num_of_vars, b);
/* calculate next temp value */
for(i=0; i<sum_num_of_vars; i++){
if(i < num_of_var_species){
var_sp[i]->temp_value -= b[i];
}else if(i < num_of_var_species+num_of_var_parameters){
var_param[i-num_of_var_species]->temp_value -= b[i];
}else if(i < num_of_var_species+num_of_var_parameters+num_of_var_compartments){
var_comp[i-num_of_var_species-num_of_var_parameters]->temp_value -= b[i];
}else{
var_spr[i-num_of_var_species-num_of_var_parameters-num_of_var_compartments]->temp_value -= b[i];
}
}
/* convergence judgement */
if(use_lazy_method){
is_convergence = 1;
for(i=0; i<sum_num_of_vars; i++){
if(fabs(b[i]) > fabs(pre_b[i])){
is_convergence = 0;
}
}
for(i=0; i<sum_num_of_vars; i++){
pre_b[i] = b[i];
}
}
/* error judgement */
flag = 0;
for(i=0; i<sum_num_of_vars; i++){
if(fabs(b[i]) > tolerance){
flag = 1;
}
}
}
/* calc temp value by assignment */
for(i=0; i<num_of_all_var_species; i++){
if(all_var_sp[i]->depending_rule != NULL && all_var_sp[i]->depending_rule->is_assignment){
all_var_sp[i]->temp_value = calc(all_var_sp[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_parameters; i++){
if(all_var_param[i]->depending_rule != NULL && all_var_param[i]->depending_rule->is_assignment){
all_var_param[i]->temp_value = calc(all_var_param[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_compartments; i++){
if(all_var_comp[i]->depending_rule != NULL && all_var_comp[i]->depending_rule->is_assignment){
all_var_comp[i]->temp_value = calc(all_var_comp[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<num_of_all_var_species_reference; i++){
if(all_var_spr[i]->depending_rule != NULL && all_var_spr[i]->depending_rule->is_assignment){
all_var_spr[i]->temp_value = calc(all_var_spr[i]->depending_rule->eq, dt, cycle, &reverse_time, 0);
}
}
/* calc temp value algebraic by algebraic */
if(algEq != NULL){
if(algEq->num_of_algebraic_variables > 1){
/* initialize pivot */
for(i=0; i<algEq->num_of_algebraic_variables; i++){
alg_pivot[i] = i;
}
for(i=0; i<algEq->num_of_algebraic_variables; i++){
for(j=0; j<algEq->num_of_algebraic_variables; j++){
coefficient_matrix[i][j] = calc(algEq->coefficient_matrix[i][j], dt, cycle, &reverse_time, 0);
}
}
for(i=0; i<algEq->num_of_algebraic_variables; i++){
constant_vector[i] = -calc(algEq->constant_vector[i], dt, cycle, &reverse_time, 0);
}
/* LU decompostion */
error = lu_decomposition(coefficient_matrix, alg_pivot, algEq->num_of_algebraic_variables);
if(error == 0){/* failure in LU decomposition */
return NULL;
}
/* forward substitution & backward substitution */
lu_solve(coefficient_matrix, alg_pivot, algEq->num_of_algebraic_variables, constant_vector);
for(i=0; i<algEq->num_of_alg_target_sp; i++){
algEq->alg_target_species[i]->target_species->temp_value = constant_vector[algEq->alg_target_species[i]->order];
}
for(i=0; i<algEq->num_of_alg_target_param; i++){
algEq->alg_target_parameter[i]->target_parameter->temp_value = constant_vector[algEq->alg_target_parameter[i]->order];
}
for(i=0; i<algEq->num_of_alg_target_comp; i++){
/* new code */
for(j=0; j<algEq->alg_target_compartment[i]->target_compartment->num_of_including_species; j++){
if(algEq->alg_target_compartment[i]->target_compartment->including_species[j]->is_concentration){
algEq->alg_target_compartment[i]->target_compartment->including_species[j]->temp_value = algEq->alg_target_compartment[i]->target_compartment->including_species[j]->temp_value*algEq->alg_target_compartment[i]->target_compartment->temp_value/constant_vector[algEq->alg_target_compartment[i]->order];
}
}
/* new code end */
algEq->alg_target_compartment[i]->target_compartment->temp_value = constant_vector[algEq->alg_target_compartment[i]->order];
}
}else{
if(algEq->target_species != NULL){
algEq->target_species->temp_value = -calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0);
}
if(algEq->target_parameter != NULL){
algEq->target_parameter->temp_value = -calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0);
}
if(algEq->target_compartment != NULL){
/* new code */
for(i=0; i<algEq->target_compartment->num_of_including_species; i++){
if(algEq->target_compartment->including_species[i]->is_concentration){
algEq->target_compartment->including_species[i]->temp_value = algEq->target_compartment->including_species[i]->temp_value*algEq->target_compartment->temp_value/(-calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0));
}
}
/* new code end */
algEq->target_compartment->temp_value = -calc(algEq->constant, dt, cycle, &reverse_time, 0)/calc(algEq->coefficient, dt, cycle, &reverse_time, 0);
}
}
}
/* preserve prev_value and prev_k for multistep solution */
for(i=0; i<num_of_var_species; i++){
var_sp[i]->prev_val[2] = var_sp[i]->prev_val[1];
var_sp[i]->prev_val[1] = var_sp[i]->prev_val[0];
var_sp[i]->prev_val[0] = var_sp[i]->value;
var_sp[i]->prev_k[2] = var_sp[i]->prev_k[1];
var_sp[i]->prev_k[1] = var_sp[i]->prev_k[0];
var_sp[i]->prev_k[0] = k_t[i];
}
for(i=0; i<num_of_var_parameters; i++){
var_param[i]->prev_val[2] = var_param[i]->prev_val[1];
var_param[i]->prev_val[1] = var_param[i]->prev_val[0];
var_param[i]->prev_val[0] = var_param[i]->value;
var_param[i]->prev_k[2] = var_param[i]->prev_k[1];
var_param[i]->prev_k[1] = var_param[i]->prev_k[0];
var_param[i]->prev_k[0] = k_t[num_of_var_species+i];
}
for(i=0; i<num_of_var_compartments; i++){
var_comp[i]->prev_val[2] = var_comp[i]->prev_val[1];
var_comp[i]->prev_val[1] = var_comp[i]->prev_val[0];
var_comp[i]->prev_val[0] = var_comp[i]->value;
var_comp[i]->prev_k[2] = var_comp[i]->prev_k[1];
var_comp[i]->prev_k[1] = var_comp[i]->prev_k[0];
var_comp[i]->prev_k[0] = k_t[num_of_var_species+num_of_var_parameters+i];
}
for(i=0; i<num_of_var_species_reference; i++){
var_spr[i]->prev_val[2] = var_spr[i]->prev_val[1];
var_spr[i]->prev_val[1] = var_spr[i]->prev_val[0];
var_spr[i]->prev_val[0] = var_spr[i]->value;
var_spr[i]->prev_k[2] = var_spr[i]->prev_k[1];
var_spr[i]->prev_k[1] = var_spr[i]->prev_k[0];
var_spr[i]->prev_k[0] = k_t[num_of_var_species+num_of_var_parameters+i];
}
/* forwarding value */
forwarding_value(all_var_sp, num_of_all_var_species, all_var_param, num_of_all_var_parameters, all_var_comp, num_of_all_var_compartments, all_var_spr, num_of_all_var_species_reference);
}
PRG_TRACE(("Simulation for [%s] Ends!\n", Model_getId(m)));
if(algEq != NULL){
for(i=0; i<algEq->num_of_algebraic_variables; i++){
free(coefficient_matrix[i]);
}
free(coefficient_matrix);
free(constant_vector);
free(alg_pivot);
}
for(i=0; i<sum_num_of_vars; i++){
free(jacobian[i]);
}
free(all_var_sp);
free(all_var_param);
free(all_var_comp);
free(all_var_spr);
free(var_sp);
free(var_param);
free(var_comp);
free(var_spr);
/* for implicit */
free(jacobian);
return result;
}
