Add serial debug header and minor fixes