Move GPIO configuration to MSP