Servo Motor (WonderKit)

[gotvinne]

• Detect if I2C connection works (if we can read registers)
• Set PWM to the 4 propellers (write / read) I2C. + Make test function