Untitled

int H = 1; // nr tranzystora gornego
int D = 2; // nr tranzystora dolnego

int inkr = 0; // licznik
// tablice wyboru kolejnosci przelaczeń
int [6] H_g = (1, 1, 2, 2, 3, 3); // górne tranzystory 
int [6] H_d = (2, 3, 3, 1, 1, 2); // dolne tranzystory
// [0, 1, ... , 5]

if(sig_A == sig_N or sig_B == sig_N or sig_C == sig_N ){
	// przechowujemy ktora faza ma byc załączona
	H = H_g[inkr];
	D = H_d[inkr];

	inkr += 1 // zwiększ licznik
	if(inkr == 6){
		inkr = 0;
	}
}

if(H == 1){
	A_h = 1;
	B_h = 0;
	C_h = 0;
}

if(H == 2){
	A_h = 0;
	B_h = 1;
	C_h = 0;
}

if(H == 3){
	A_h = 0;
	B_h = 0;
	C_h = 1;
}

if(D == 1){
	A_d = 1;
	B_d = 0;
	C_d = 0;
}

if(D == 2){
	A_d = 0;
	B_d = 1;
	C_d = 0;
}

if(D == 3){
	A_d = 0;
	B_d = 0;
	C_d = 1;
}