working mag motor compensation
added i2c 400khz mode. also change twi.h in arduino libs!