Fixing setting port logic
Merge branch 'digital_output_control' into rygy_custom