Fix button code, now correctly sets pull-up's and reads correct registers