Few modifications, mainly for tests too debug printing.

I think the problem comes from linker script. When compiling
Cambridge University project on raspberry, I have same bug, which
doesn't appear when cross-compiling with given kernel.ld

I have to figure out that stuff.