Adjust Taras code to compile

[vladsud]

Code based on https://github.com/Vladimirtrif/Team-949z_Pelmen_Vex_21-22/issues/12 Did not review it or tested, just made compile