Remove configuration when polling. use P_SET is better since we have slave address on IIC
Minor changes