Problema con multiplexador I2C

Por si resulta de interés a alguien.

El código está bien escrito. Mi problema era que seguía el diagrama de conexiones correspondientes a la placa UNO para las señales SDA y SCL, y en mi placa, una MEGA, estas señales están en pines diferentes.

Saludos