Package multiplexer adress setting in own function

[liquidcronos]

Since extend sensor, swing sensor and the later IMU will have to set the chipselect adress using the multiplexer this function should be defined once and called by each sensor.