ioports: Cleanup and implement PINx toggle