You are right.
I was something i knew earlier because i ones had this problem already, but please look at this picture from grabcad of the 7i76E on bottom (The inputs seem to be wrong, but when counting from the input 16 from TB6 and continue terminal TB5 to pin 22 then it seems to be the correct inputs)
Because of that picture i choosed Input 21 and 22. I am now a bit angry about my self, because i thought about it to change in the .hal to input 20 and 21 before i wrote the thread, but i dont know why i have not done it.. I could save your and my time, because that was the only reason why the switch/settings did not work properly.
EDIT: i edited the picture and marked the correct Pin names for the .HAL. This might help others in future so that they not get confused by the original picture which was not edited.