void CONSTR_BOUND_eval_step(Constr* c, Branch* br, int t, Vec* var_values) {
// Local variables
Bus* buses[2];
Bus* bus;
Gen* gen;
Shunt* shunt;
Mat* H_array;
REAL* f;
REAL* J;
Mat* H;
int* Jcounter;
char* bus_counted;
int bus_index_t[2];
int k;
REAL u;
REAL umin;
REAL umax;
REAL du;
REAL a1;
REAL a2;
REAL b;
REAL eps;
REAL sqrterm1;
REAL sqrterm2;
int T;
// Number of periods
T = BRANCH_get_num_periods(br);
// Constr data
f = VEC_get_data(CONSTR_get_f(c));
J = MAT_get_data_array(CONSTR_get_J(c));
H_array = CONSTR_get_H_array(c);
Jcounter = CONSTR_get_Jcounter_ptr(c);
bus_counted = CONSTR_get_bus_counted(c);
// Check pointers
if (!f || !J || !Jcounter || !bus_counted)
return;
// Check outage
if (BRANCH_is_on_outage(br))
return;
// Param
eps = CONSTR_BOUND_PARAM;
// Bus data
buses[0] = BRANCH_get_bus_from(br);
buses[1] = BRANCH_get_bus_to(br);
for (k = 0; k < 2; k++)
bus_index_t[k] = BUS_get_index(buses[k])*T+t;
// Branch
//*******
// Tap ratio
if (BRANCH_has_flags(br,FLAG_BOUNDED,BRANCH_VAR_RATIO) &&
BRANCH_has_flags(br,FLAG_VARS,BRANCH_VAR_RATIO)) {
u = VEC_get(var_values,BRANCH_get_index_ratio(br,t));
umax = BRANCH_get_ratio_max(br);
umin = BRANCH_get_ratio_min(br);
du = (umax-umin > eps) ? umax-umin : eps;
a1 = umax-u;
a2 = u-umin;
b = eps*eps/du;
sqrterm1 = sqrt(a1*a1+b*b+eps*eps);
sqrterm2 = sqrt(a2*a2+b*b+eps*eps);
// f
f[*Jcounter] = a1 + b - sqrterm1; // upper
f[*Jcounter+1] = a2 + b - sqrterm2; // lower
// J
J[*Jcounter] = -(1-a1/sqrterm1);
J[*Jcounter+1] = (1-a2/sqrterm2);
// H
H = MAT_array_get(H_array,*Jcounter);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm1*sqrterm1*sqrterm1));
H = MAT_array_get(H_array,*Jcounter+1);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm2*sqrterm2*sqrterm2));
(*Jcounter)++;
(*Jcounter)++;
}
// Phase shift
if (BRANCH_has_flags(br,FLAG_BOUNDED,BRANCH_VAR_PHASE) &&
BRANCH_has_flags(br,FLAG_VARS,BRANCH_VAR_PHASE)) {
u = VEC_get(var_values,BRANCH_get_index_phase(br,t));
umax = BRANCH_get_phase_max(br);
umin = BRANCH_get_phase_min(br);
du = (umax-umin > eps) ? umax-umin : eps;
a1 = umax-u;
a2 = u-umin;
b = eps*eps/du;
sqrterm1 = sqrt(a1*a1+b*b+eps*eps);
sqrterm2 = sqrt(a2*a2+b*b+eps*eps);
// f
f[*Jcounter] = a1 + b - sqrterm1; // upper
f[*Jcounter+1] = a2 + b - sqrterm2; // lower
// J
J[*Jcounter] = -(1-a1/sqrterm1);
J[*Jcounter+1] = (1-a2/sqrterm2);
// H
H = MAT_array_get(H_array,*Jcounter);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm1*sqrterm1*sqrterm1));
H = MAT_array_get(H_array,*Jcounter+1);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm2*sqrterm2*sqrterm2));
(*Jcounter)++;
(*Jcounter)++;
}
// Buses
//******
for (k = 0; k < 2; k++) {
bus = buses[k];
if (!bus_counted[bus_index_t[k]]) { // not counted yet
// Voltage magnitude (V_MAG)
if (BUS_has_flags(bus,FLAG_BOUNDED,BUS_VAR_VMAG) &&
BUS_has_flags(bus,FLAG_VARS,BUS_VAR_VMAG)) {
u = VEC_get(var_values,BUS_get_index_v_mag(bus,t));
umax = BUS_get_v_max(bus);
umin = BUS_get_v_min(bus);
du = (umax-umin > eps) ? umax-umin : eps;
a1 = umax-u;
a2 = u-umin;
b = eps*eps/du;
sqrterm1 = sqrt(a1*a1+b*b+eps*eps);
sqrterm2 = sqrt(a2*a2+b*b+eps*eps);
// f
f[*Jcounter] = a1 + b - sqrterm1; // upper
f[*Jcounter+1] = a2 + b - sqrterm2; // lower
// J
J[*Jcounter] = -(1-a1/sqrterm1);
J[*Jcounter+1] = (1-a2/sqrterm2);
// H
H = MAT_array_get(H_array,*Jcounter);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm1*sqrterm1*sqrterm1));
H = MAT_array_get(H_array,*Jcounter+1);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm2*sqrterm2*sqrterm2));
(*Jcounter)++;
(*Jcounter)++;
}
// Volage angle (V_ANG)
if (BUS_has_flags(bus,FLAG_BOUNDED,BUS_VAR_VANG) &&
BUS_has_flags(bus,FLAG_VARS,BUS_VAR_VANG)) {
u = VEC_get(var_values,BUS_get_index_v_ang(bus,t));
umax = 2*PI;
umin = -2*PI;
du = (umax-umin > eps) ? umax-umin : eps;
a1 = umax-u;
a2 = u-umin;
b = eps*eps/du;
sqrterm1 = sqrt(a1*a1+b*b+eps*eps);
sqrterm2 = sqrt(a2*a2+b*b+eps*eps);
// f
f[*Jcounter] = a1 + b - sqrterm1; // upper
f[*Jcounter+1] = a2 + b - sqrterm2; // lower
// J
J[*Jcounter] = -(1-a1/sqrterm1);
J[*Jcounter+1] = (1-a2/sqrterm2);
// H
H = MAT_array_get(H_array,*Jcounter);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm1*sqrterm1*sqrterm1));
H = MAT_array_get(H_array,*Jcounter+1);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm2*sqrterm2*sqrterm2));
(*Jcounter)++;
(*Jcounter)++;
}
// Generators
for (gen = BUS_get_gen(bus); gen != NULL; gen = GEN_get_next(gen)) {
// Active power (P)
if (GEN_has_flags(gen,FLAG_BOUNDED,GEN_VAR_P) &&
GEN_has_flags(gen,FLAG_VARS,GEN_VAR_P)) {
u = VEC_get(var_values,GEN_get_index_P(gen,t));
umax = GEN_get_P_max(gen);
umin = GEN_get_P_min(gen);
du = (umax-umin > eps) ? umax-umin : eps;
a1 = umax-u;
a2 = u-umin;
b = eps*eps/du;
sqrterm1 = sqrt(a1*a1+b*b+eps*eps);
sqrterm2 = sqrt(a2*a2+b*b+eps*eps);
// f
f[*Jcounter] = a1 + b - sqrterm1; // upper
f[*Jcounter+1] = a2 + b - sqrterm2; // lower
// J
J[*Jcounter] = -(1-a1/sqrterm1);
J[*Jcounter+1] = (1-a2/sqrterm2);
// H
H = MAT_array_get(H_array,*Jcounter);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm1*sqrterm1*sqrterm1));
H = MAT_array_get(H_array,*Jcounter+1);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm2*sqrterm2*sqrterm2));
(*Jcounter)++;
(*Jcounter)++;
}
// Reactive power (Q)
if (GEN_has_flags(gen,FLAG_BOUNDED,GEN_VAR_Q) &&
GEN_has_flags(gen,FLAG_VARS,GEN_VAR_Q)) {
u = VEC_get(var_values,GEN_get_index_Q(gen,t));
umax = GEN_get_Q_max(gen);
umin = GEN_get_Q_min(gen);
du = (umax-umin > eps) ? umax-umin : eps;
a1 = umax-u;
a2 = u-umin;
b = eps*eps/du;
sqrterm1 = sqrt(a1*a1+b*b+eps*eps);
sqrterm2 = sqrt(a2*a2+b*b+eps*eps);
// f
f[*Jcounter] = a1 + b - sqrterm1; // upper
f[*Jcounter+1] = a2 + b - sqrterm2; // lower
// J
J[*Jcounter] = -(1-a1/sqrterm1);
J[*Jcounter+1] = (1-a2/sqrterm2);
// H
H = MAT_array_get(H_array,*Jcounter);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm1*sqrterm1*sqrterm1));
H = MAT_array_get(H_array,*Jcounter+1);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm2*sqrterm2*sqrterm2));
(*Jcounter)++;
(*Jcounter)++;
}
}
// Shunts
for (shunt = BUS_get_shunt(bus); shunt != NULL; shunt = SHUNT_get_next(shunt)) {
// Susceptance
if (SHUNT_has_flags(shunt,FLAG_BOUNDED,SHUNT_VAR_SUSC) &&
SHUNT_has_flags(shunt,FLAG_VARS,SHUNT_VAR_SUSC)) {
u = VEC_get(var_values,SHUNT_get_index_b(shunt,t));
umax = SHUNT_get_b_max(shunt);
umin = SHUNT_get_b_min(shunt);
du = (umax-umin > eps) ? umax-umin : eps;
a1 = umax-u;
a2 = u-umin;
b = eps*eps/du;
sqrterm1 = sqrt(a1*a1+b*b+eps*eps);
sqrterm2 = sqrt(a2*a2+b*b+eps*eps);
// f
f[*Jcounter] = a1 + b - sqrterm1; // upper
f[*Jcounter+1] = a2 + b - sqrterm2; // lower
// J
J[*Jcounter] = -(1-a1/sqrterm1);
J[*Jcounter+1] = (1-a2/sqrterm2);
// H
H = MAT_array_get(H_array,*Jcounter);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm1*sqrterm1*sqrterm1));
H = MAT_array_get(H_array,*Jcounter+1);
MAT_set_d(H,0,-(b*b+eps*eps)/(sqrterm2*sqrterm2*sqrterm2));
(*Jcounter)++;
(*Jcounter)++;
}
}
}
// Update counted flag
bus_counted[bus_index_t[k]] = TRUE;
}
}
void FUNC_REG_PQ_eval_step(Func* f, Branch* br, int t, Vec* var_values) {
// Local variables
Bus* bus[2];
Gen* gen;
int bus_index_t[2];
char* bus_counted;
REAL* phi;
REAL* gphi;
REAL Qmid;
REAL Pmid;
REAL P;
REAL Q;
REAL dP;
REAL dQ;
int k;
int T;
// Num periods
T = BRANCH_get_num_periods(br);
// Constr data
phi = FUNC_get_phi_ptr(f);
gphi = VEC_get_data(FUNC_get_gphi(f));
bus_counted = FUNC_get_bus_counted(f);
// Check pointers
if (!phi || !gphi || !bus_counted)
return;
// Check outage
if (BRANCH_is_on_outage(br))
return;
// Bus data
bus[0] = BRANCH_get_bus_from(br);
bus[1] = BRANCH_get_bus_to(br);
for (k = 0; k < 2; k++)
bus_index_t[k] = BUS_get_index(bus[k])*T+t;
// Buses
for (k = 0; k < 2; k++) {
if (!bus_counted[bus_index_t[k]]) {
// Generators
for (gen = BUS_get_gen(bus[k]); gen != NULL; gen = GEN_get_next(gen)) {
// Mid value
Qmid = (GEN_get_Q_max(gen)+GEN_get_Q_min(gen))/2.; // p.u.
Pmid = (GEN_get_P_max(gen)+GEN_get_P_min(gen))/2.; // p.u.
// Normalization factor
dQ = GEN_get_Q_max(gen)-GEN_get_Q_min(gen); // p.u.
if (dQ < FUNC_REG_PQ_PARAM)
dQ = FUNC_REG_PQ_PARAM;
dP = GEN_get_P_max(gen)-GEN_get_P_min(gen); // p.u.
if (dP < FUNC_REG_PQ_PARAM)
dP = FUNC_REG_PQ_PARAM;
if (GEN_has_flags(gen,FLAG_VARS,GEN_VAR_Q)) { // Q var
// Value
Q = VEC_get(var_values,GEN_get_index_Q(gen,t));
// phi
(*phi) += 0.5*pow((Q-Qmid)/dQ,2.);
// gphi
gphi[GEN_get_index_Q(gen,t)] = (Q-Qmid)/(dQ*dQ);
}
else {
// Value
Q = GEN_get_Q(gen,t);
// phi
(*phi) += 0.5*pow((Q-Qmid)/dQ,2.);
}
if (GEN_has_flags(gen,FLAG_VARS,GEN_VAR_P)) { // P var
// Value
P = VEC_get(var_values,GEN_get_index_P(gen,t));
// phi
(*phi) += 0.5*pow((P-Pmid)/dP,2.);
// gphi
gphi[GEN_get_index_P(gen,t)] = (P-Pmid)/(dP*dP);
}
else {
// Value
P = GEN_get_P(gen,t);
// phi
(*phi) += 0.5*pow((P-Pmid)/dP,2.);
}
}
}
// Update counted flag
bus_counted[bus_index_t[k]] = TRUE;
}
}
void FUNC_GEN_COST_eval_step(Func* f, Branch* br, int t, Vec* var_values) {
// Local variables
Bus* buses[2];
Bus* bus;
Gen* gen;
int bus_index_t[2];
char* bus_counted;
REAL* phi;
REAL* gphi;
int index_P;
REAL P;
REAL Q0;
REAL Q1;
REAL Q2;
int k;
int T;
// Num periods
T = BRANCH_get_num_periods(br);
// Constr data
phi = FUNC_get_phi_ptr(f);
gphi = VEC_get_data(FUNC_get_gphi(f));
bus_counted = FUNC_get_bus_counted(f);
// Check pointers
if (!phi || !gphi || !bus_counted)
return;
// Check outage
if (BRANCH_is_on_outage(br))
return;
// Bus data
buses[0] = BRANCH_get_bus_k(br);
buses[1] = BRANCH_get_bus_m(br);
for (k = 0; k < 2; k++)
bus_index_t[k] = BUS_get_index(buses[k])*T+t;
// Buses
for (k = 0; k < 2; k++) {
bus = buses[k];
if (!bus_counted[bus_index_t[k]]) {
for (gen = BUS_get_gen(bus); gen != NULL; gen = GEN_get_next(gen)) {
Q0 = GEN_get_cost_coeff_Q0(gen);
Q1 = GEN_get_cost_coeff_Q1(gen);
Q2 = GEN_get_cost_coeff_Q2(gen);
// Variable
if (GEN_has_flags(gen,FLAG_VARS,GEN_VAR_P)) {
// Index
index_P = GEN_get_index_P(gen,t);
// P
P = VEC_get(var_values,index_P);
// phi
(*phi) += Q0 + Q1*P + Q2*pow(P,2.);
// gphi
gphi[index_P] = Q1 + 2.*Q2*P;
}
// Constant
else {
// P
P = GEN_get_P(gen,t);
// phi
(*phi) += Q0 + Q1*P + Q2*pow(P,2.);
}
}
}
// Update counted flag
bus_counted[bus_index_t[k]] = TRUE;
}
}
