set pin_mode before digital_write
add servo_write test  #16