Add debug code printing to Serial monitor