Added sleeps while polling.
Reduced socket timeout.
Bug in setting servo.
Only activate IMU.