Sensor loop (4 IR + gyro) working