Added pca9543 library routines (I2C switch)
Cleaned up (Remove redundant SDA high, etc.)