Arduino Code If Else Statement In C