raspi
i2c: move everytihng to one statemachine and fix servo-dance