target/adi_v5_swd: improve error check while updating DP_SELECT