Driver for firing multiple i2c sonars individually

New driver for firing up to six i2c sonars to our pixhawk. Based on how much sonars are detected it choses an appropriate firing scheme to miimise interference. Simply connect the i2c sonars through i2c splitter(s) and make sure they each are assigned the correct i2c adress as noted in the driver. 

Status: Compilation is succesfull and testing has been done with the DIY/PX4Firmware fork, but not yet the master fork.
Where do the switch statements here come from? I don't think you need to copy & paste all the code just to read from a different address.