Fungerar nästan att printa ut kortaste vägen. Får segfault i print