Tested the functions. Added lots of kprintf-commands for printing what the code does.