swd_gpio.cpp: add debug print

Signed-off-by: Federico Vaga <federicov@linino.org>