Fix digitalWrite()