fsi/fsi-master-gpio: More error handling cleanup