PaulS:
Switches don't normally get driven. What ARE you thinking?
Yup, got that wrong, realized in the morning when reviewed it. As for code itself, I think you are right, it is because its done as per function block, but it is not the power as there is external power supply with enough Amps.
Will look into mentioned libraries.
Thanks Robin2, corrected it 
As for the loop, that does make sense, will re-piece everything and will see how it goes.