rlctrans/pfcboost.c at master · jmtilli/rlctrans · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
#include <stdio.h>
#include <math.h>
#include "libsimul.h"

const double dt = 1e-7; // 100 ns

static inline int my_signum(double d)
{
	if (d > 0)
	{
		return 1;
	}
	if (d < 0)
	{
		return -1;
	}
	return 0;
}

int main(int argc, char **argv)
{
	size_t i;
	double t = 0.0;
	const double pi = 3.14159265358979;
	const double f_tgt = 50.0;
	double Vrms = 230;
	double Vrms_accumulator = 0;
	int Vrms_cnt = 0;
	int switch_state = 1;
	int cnt_remain = 90;
	int cnt_on = 0;
	double I_ideal_rms_230 = 0.5;
	double I_diff_single = 0.0;
	int sign_last_nonzero = 0;
	int cycle_cnt = 0;
	const double V_tgt = 230*sqrt(2)*1.2;
	double C;
	struct libsimul_ctx ctx;
	libsimul_init(&ctx, dt);
	read_file(&ctx, "pfcboost.txt");
	init_simulation(&ctx);
	C = get_capacitor(&ctx, "C1");
	if (set_switch_state(&ctx, "S1", switch_state) != 0)
	{
		recalc(&ctx);
	}
	for (i = 0; i < 5*1000*1000; i++)
	{
		double V_input = 230*sqrt(2)*sin(2*pi*50*t);
		Vrms_accumulator += V_input*V_input;
		Vrms_cnt++;
		double I_ideal = (I_ideal_rms_230+I_diff_single)*fabs(V_input)/Vrms;
		set_voltage_source(&ctx, "V1", V_input);
		t += dt;
		simulation_step(&ctx);
		double I_ind = -get_inductor_current(&ctx, "L1");
		double V_rect = get_V(&ctx, 2) - get_V(&ctx, 3);
		double V_out = get_V(&ctx, 6) - get_V(&ctx, 3);
		printf("%zu %g (%d) %g %g %g\n", i, V_input, switch_state, V_out, V_rect, I_ind);
		if (my_signum(V_input) != 0)
		{
			if (sign_last_nonzero != my_signum(V_input))
			{
				double E_cap;
				double E_ideal;
				cycle_cnt++;
				E_cap = 0.5*C*V_out*V_out;
				if (V_out < 230*sqrt(2))
				{
					// Avoid current surge at ramp-up
					E_cap = 0.5*C*230*230*2;
				}
				E_ideal = 0.5*C*V_tgt*V_tgt;
				if (Vrms_cnt > 0.5/(2*f_tgt)/dt && cycle_cnt >= 2)
				{
					Vrms = sqrt(Vrms_accumulator/Vrms_cnt);
					//fprintf(stderr, "Vrms: %g\n", Vrms);
					Vrms_accumulator = 0;
					Vrms_cnt = 0;
					if (Vrms < 230*0.9)
					{
						Vrms = 230*0.9;
					}
					else if (Vrms > 230*1.1)
					{
						Vrms = 230*1.1;
					}
				}
				I_diff_single = (E_ideal-E_cap)*2*f_tgt/Vrms;
				if (V_out < 230*sqrt(2)*0.9 || cycle_cnt < 2)
				{
					I_diff_single = 0;
				}
				else
				{
					I_ideal_rms_230 += I_diff_single/20.0;
				}
				I_diff_single = 19.0/20.0*I_diff_single;
			}
			sign_last_nonzero = my_signum(V_input);
		}
		cnt_remain--;
		if (switch_state && I_ind > I_ideal + 0.01)
		{
			cnt_remain = 0;
		}
		else if (!switch_state && I_ind < I_ideal - 0.01)
		{
			cnt_remain = 0;
		}
		if (switch_state)
		{
			cnt_on++;
		}
		if (cnt_remain == 0)
		{
			switch_state = !switch_state;
			if (set_switch_state(&ctx, "S1", switch_state) != 0)
			{
				recalc(&ctx);
			}
			if (switch_state)
			{
				cnt_remain = 100000;
				cnt_on = 0;
			}
			else
			{
				cnt_remain = 100000;
			}
		}
	}
	libsimul_free(&ctx);
	return 0;
}