fix calibration on gyro
prevent double initalization error on wmp
Add position convenience to wmp
add convenience initialize argument i2c to wmp