Add gpio write out and pins set