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; } }