add new function to wiring_digital.c

Why do you want to modify digitalWrite? To make it faster?