Spanet SV2 code adaptation

[Villhahallon]

Hello!
After not giving up on getting this to work on my SV2 without an wifi module, I have managed to get most of it working anyway. some modifications to the code in SpaNetController.cpp I get most of the sensors and can turn on the light, I can also work the thermostat and change mode and temperature.
Now I struggle with the pumps instead.

The registers are not the same as on the SV3 but I think that the pumps get the correct register. I managed to operate my broken keypad to test the pumps and the registers.
The problem is when changing mode in Home Assistant with the switches. it sends the command S22 for pump 1 when trying to change mode on pump1.
but nothing happens, the switch return back to the previous state.
Is there a way to test this better or figure out this ? I will be happy if someone could help me out.